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ABSTRACT 


The  theory,  detailed  outline  of  operating  and 
algorithm  procedures  of  a  continuous  time-invariant, 
linear  control  state  variable  systems  design  and 
analysis  computer  program  is  presented.  The  program, 
SVS,  which  is  based  on  Melsa’s  LINCON,  was  modified  to 
demonstrate  Controllability,  Observability,  Bode  Plot, 
Root  locus  plot,  Nyquist  plot,  pole  placement, 
Luenberger  observer  design,  optimal  control  design, 
time  response  plot  and  some  basic  matrix  manipulations. 
Worked  examples  with  the  program  output  are  included. 
Some  options  give  only  numeric  data  output;  others  give 
both  numeric  data  and  high-resolution  graphs.  The 
software,  which  is  fully  interactive,  menu  driven  and 
user  friendly  is  written  in  Turbo  Pascal  to  be  run  on 
the  IBM- PC  microcomputers.  All  options  are  presented 
via  option  menus  and  the  user  will  be  prompted  for  all 
input  parameters. 
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C.  LINEAR  CONTROL  STATE  VARIABLE  SYSTEMS 


(SVS) 

A.  INTRODUCTION  TO  THE  SVS 

SVS  is  software  for  the  IBM-PC  microcomputer  in 
the  analysis  and  design  of  continuous  time,  linear 
control  systems.  These  programs  are  based  on  the  matrix 
mathematics  of  state  variables  and  were  first  developed 
by  Melsa  [Ref.  1]  and  adapted  for  batch  use  at  NPS  by 
Desjardins  [Ref.  2]. 

The  original  intent  of  this  thesis  was  simply  to 
take  Desjardins’  adapted  version  of  Melsa’ s  LINCON  and 
modify  it  for  the  Turbo  Pascal  computer  language.  The 
features  of  this  thesis  are: 

-  User-friendly  as  possible 

-  Menu-driven  program.  <Q>quit  key  always  returns  to 

the  SVS  main  menu. 

The  hierarchical  menu  structure  is  three  levels 
deep  at  any  point.  So  the  user,  before  selecting 
his/her  option,  can  get  help  at  every  menu. 

SVS  was  tested  with  several  examples  and  is  now 
available  to  any  user  on  the  Naval  PostGraduate  School 
control  laboratory  PC’s  under  the  SVS  directory  name. 

B .  SYSTEM  REQUIREMENTS 

SVS  is  a  large  program  and  requires  at  least  512KB 
of  Memory  to  run.  The  program  will  run  on  any  IBM-PC  or 
compatible  "MS-DOS"  computer  and  requires  a  standard 
IBM  color  Graphics  Adapter  (CGA)  or  IBM  Enhanced 
Graphics  Adapter  (EGA)  card.  It  will  run  on  either 
monochrome  or  color  monitor,  but  all  menus  are 
supported  by  color,  for  that  reason  they  are  easier  to 
work  with  a  color  monitor  if  available.  The  graphics  in 
the  program  are  in  high  resolution  (640  X  200)  mode. 
They  only  appear  in  the  white-on-black.  The  graphics 


can  be  dumped  to  an  EPSON,  IBM-Graphics ,  or  compatible 
printer  by  using  the  Shift  +  PrtSc  key. 

The  program  is  written  in  the  Turbo  Pascal 
Language.  Turbo  Pascal  has  a  64K  data  segment  and  code 
sizes  limitation.  Under  this  restriction,  SVS  is 
compiled  as  five  executable  programs  and  nineteen 
"Chain"  files.  The  main  program  name  is  SVS  in  the  disk 
files.  It  has  extension  .COM.  The  chain  files  have 
extension  .CHN  and  they  are  not  themselves  executable. 

C.  FILES  ON  THE  DISK 

A  complete  list  of  the  files  and  a  brief 

description  of  these  are  below. 

(1)  SVS.COM  {  The  executable  main  menu  module  > 

(2)  INPUT.COM  {  The  input /change  menu  module  } 

(3)  MATRIX.COM  <  The  matrix  mathematics  menu  module) 

(4)  PLOT.COM  {  The  graphics  menu  module  ) 

(5)  CHANGE. CHN  {  Allows  user  to  change  input  data 

<  values) 

(6)  POLYNOM . CHN  {  Calculates  characteristic 

{  polynomial  of  A  matrix  ) 

(7)  CONTROL. CHN  <  Calculates  controllability  of  the 

{  system  ) 

( 8 ) DETERMIN . CHN  {  Calculates  determinant  of  the  A 

{  matrix  ) 

(9)  EIGEN. CHN  {  Shows  eigenvalues  of  the  A  matrix  ) 

(10) BODE.CHN  <  Gives  Bode  plot  of  the  system  ) 

( 1 1 ) TIMEPL0T . CHN{  Gives  time  response  of  the  system) 

( 1 2 ) 0BSER . CHN  {  Calculates  observability  of  the 

<  system) 

( 1 3 ) LUENBERG. CHN{  Design  Luenberger  observer  to 

<  achieve  a  closed-loop  poles  of  the 

{  system  ) 

( 1 4 ) 0PTIMAL . CHN  {  Optimal  control  design  program  ) 


( 1 5) POLE. COM 


{  To  calculate  feedback  coefficients 
<  to  achieve  a  desired  closed-loop 
{  poles  > 

(16) SAVE.CHN  {  Saves  data  to  desired  drive  > 

( 1 7 )  RETRIEVE . CHN  {  Gets  data  from  desired  drive  > 

( 18) INVERSE.CHN  {  To  calculate  inverse  of  the  A 

{  matrix  > 

( 1 9 )  INPUTDAT . CHN  {  To  permit  user  to  enter  the  input 

(  data  for  whole  system  } 

( 20 ) HELP1 . CHN  {  Help  program  for  SVS  main  menu 

{  options) 

(21 ) HELP2 . CHN  {  Help  information  for  the 

(  input/change  menu  options  ) 

( 22 ) HELP3 • CHN  (  Help  information  for  the  matrix 

{  mathematics  menu  option  > 

( 23 ) HELP4 . CHN  (  Help  information  for  graphics  menu 

{  option  > 

( 24 ) NYQUIST . CHN  (  to  calculate  Nyquist  (polar)  plot 

(  of  the  system  ) 

(25) RL0CI .CHN  {  Root  locus  plotting  procedure) 

( 26 ) ROOTS . CHN  (  Shows  plant  characteristic 

(  equation  roots  ) 


In  addition  to  these  files,  there  are  three 
"system"  files  that  are  needed  to  run  the  program. 
These  are  4X6. FON,  8X8. FON  and  ERROR. MSG  files. 


D.  STARTING  TO  THE  SVS 

This  software  package  has  two  diskettes.  The  first 
step  is  to  get  the  SVS  main  menu  on  your  screen.  All 
you  have  to  do  is  follow  these  steps: 


2.  Wait  for  the  operating  system  prompt.  It  will 
look  like  one  of  the  following: 

C 

C>_ 

C\>_ 

C:\_ 

C:  \>_ 

<C\>_ 

(or  some  other  letter). 

The  prompt  may  look  somewhat  different,  depending 
on  the  computer  and  how  it  has  been  set  up. 

3.  Type  MD  SVS  and  press  <ENTER>  key.  This  opens  a 
new  directory. 

4.  Type  CD\SVS  and  press  <ENTER>  key.  This  enters 
the  new  directory. 

5.  Insert  disk  #1  into  disk  driver  A: 

Type  Copy  A:*."  and  press  <ENTEK>  key. 

6.  Repeat  step  5  for  disk  #2. 

7.  Type  SVS  and  press  <ENTER>  key. 

Now  the  user  is  in  the  SVS  main  menu  and  ready  to 
irk.  Make  a  choice  for  further  step. 


II.  INPUT /CHANGE  MENU 

A.  INTBODUCTION  TO  THE  INPUT/CHANGE  MENU 

The  first  step,  of  course,  is  to  enter  the  A,  B  and 
C  matrices  into  the  computer  as  a  common  input.  This 
is  the  starting  point  of  the  program.  For  our  case, 
the  general  state  variable  equations  are  represented  by 
the  following  equations. 

x(t)  =  A  x(t)  +  B  u(t )  (2-1  ) 

y(t)  =  C  x(t)  +  D  u(t)  (2-2) 

where  A,  B,  C  are  given  matrices  and  D  is  assumed  to 
have  a  zero  elements  for  this  program. 


_ «»»  SYS  MAIN  MENU  ***** _ 

(I)  Input/Change  Plant  Matrices  Menu 

(G)  Graphics  Menu 

(C)  Controllability 

(O)  Observability 

(L)  Luenberger  Observer  Design 

(D)  Design  of  Optimal  Control 

(P)  Pole  Placement 

(M)  Matrix  Mathematics  Menu 

(H)  Help 

(Q)  Quit  the  Program 
Make  Your  Selection_ 

Naval  Postgraduate  School  Ismail  UNLU 


Figure  2.1  The  SYS  main  menu. 
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From  the  opening  menu  of  SVS,  shown  in  Figure  2.1, 
we  choose  the  " Input /Change  Plant  Matrices  Menu" 
option  to  bring  us  to  the  Input/Change  menu  shown  in 
Figure  2.2. 


_ »»»  INPUT  /  CHANGE  MENU  *»» _ 

(I)  Input  Plant  Matrices 

(C)  Change  Current  Plant  Matrices 

(S)  Save  Plant  Matrices  to  Disk  File 
(L)  Load  Plant  Matrices  From  Disk  File 

(H)  Help 

(Q)  Quit  to  SVS  Main  Menu 

Make  Your  Selection 


Figure  2.2  The  input /change  menu. 


This  input/change  menu  allows  the  user  to  enter 
common  inputs  to  all  programs.  These  common  inputs  are 
the  plant  or  A  matrix,  the  input  or  B  matrix  and  the 
output  or  C  matrix.  The  only  restriction  is  the 

dimensions  of  the  matrix.  It  must  be  no  greater  than 
10.  This  means  that  the  maximum  matrix  size  has  to  be 
10X10.  However,  due  to  a  user  decision,  a  dimension 
size  not  to  exceed  6  is  required.  The  reasoning  behind 
this  was  due,  in  part,  to  the  printer.  Since  the 
output  format  to  the  printer  is  Ell,  this  naturally 
limits  us  to  6  numbers  per  line.  12  format  places  are 


1  3 


normally  considered  necessary  for  good  accuracy.  For 
systems  with  order  greater  than  6,  every  row  of  the 
matrix  is  continued  on  the  second  line.  After 
attempting  this,  it  was  decided  the  results  were 
difficult  to  read.  Otherwise  it  is  appropriate  up  to  a 
10th  order  system. 

B.  INPUT  PLANT  MATRICES 

This  option  is  used  to  initially  enter  the  A,  B  and 
C  matrices  of  the  state  variable  equations  (2-1)  and 
(2-2).  For  this  option,  select  the  "Input  plant 
matrices"  from  the  input /change  menu.  The  screen  will 
prompt  the  degree  of  the  plant,  which  is  the  dimension 
of  the  A  matrix.  The  maximum  acceptable  degree  is  10. 
Then  it  asks  for  elements  of  the  A  matrix  and  so  forth. 

Matrices  are  entered  one  element  at  a  time 
beginning  with  1 , 1  and  continuing  across  the  row  of  the 
matrix.  The  next  row  is  then  entered,  and  the  process 
continues  until  all  elements  have  been  entered.  After 
the  matrix  is  entered,  the  complete  matrix  is 
automatically  brought  to  the  screen  for  review  and 
possible  element  changes.  If  a  change  to  the  matrix  is 
desired  the  user  simply  enters  the  row  and  column 
number  to  change  after  every  prompt.  Then  the  program 
asks  for  corresponding  matrix  elements  to  change. 
After  being  prompted,  the  change  is  entered.  A  review 
of  the  matrix  is  again  brought  to  the  screen.  The  user 
is  again  prompted  for  any  more  possible  changes.  This 
procedure  continues  until  all  changes  have  been  done. 
The  same  A  matrix  procedures  are  repeated  for  the  B  and 
C  matrices.  This  input  data  can  be  used  for  the 
options  without  saving  to  disk  file  until  quitting  the 
program . 
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C.  CHANGE  CURRENT  PLANT  MATRICES 

This  option  allows  the  user  to  change  input  data  A, 
B  and  C  matrices  quickly  and  easily.  The  user  can 
change  the  order  and  elements  of  the  matrices  that  were 
previously  entered.  This  powerful  combination 
facilitates  both  input  correction  and  changes, 
especially  for  higher  order  matrices  during  the  design 
process.  First  Figure  2.3  appears  on  the  screen.  The 
user  can  choose  one  matrix  at  a  time  for  correction. 
Then  the  program  gives  the  order  and  elements  of  the 
selected  matrix.  In  the  beginning  the  user  can  enter  a 


***  Change  Current  Plant  Matrices  Procedure  *  *  * 


Which  matrix  do  you  want  to  change  ?  PLANT  (A)  A_ 

INPUT  (B) 
OUTPUT  (C) 


Press  <ESC>  to  change  it!. 

Then  input  your  choice  with  <ENTER>  key 


Figure  2.3  Change  current  plant  matrices  selection 


correction  to  the  order  of  the  matrix.  Then,  under  the 
new  dimension,  can  make  corrections  on  elements  of  the 
matrix.  The  program  shows  the  corrected  results  on  the 
screen.  At  the  end  of  the  program,  the  user 
automatically  returns  to  the  input/change  menu.  If  the 
user  wants  to  change  more  than  one  matrix,  he/she  must 


choose  the  "Change  Current  Plant  Matrices"  option  two 
or  more  times.  A  basic  example  for  this  option  is 
illustrated  in  Figure  2.4. 

D.  SAVE  CURRENT  MATRICES  TO  DISK  FILE 

This  procedure  is  used  to  store  plant  matrices  to 
the  hard  disk  or  floppy  disk  file.  First  it  prompts 
drive  C  as  a  saving  drive.  Then  asks  the  user  for  the 
drive  designator  (A  through  E),  and  filename  for  the 
problem  to  be  saved.  Eight  characters  of  a  MS-DOS 
filename  are  allowed;  the  program  gives  a  filename 
extension  of  ".SVS"  to  each  data.  This  extension  is 
used  to  limit  the  disk  search  for  appropriate  fiies.  A 
drive  and  filename  are  supplied  by  the  program,  which 
opens  the  file  and  stores  the  data.  The  procedure 
stores  the  data  as  a  text  file.  A  text  file  consists 
of  ASCII  characters,  and  is  usually  designed  to  hold 
readable  information  [Ref.  3] • 

E.  LOAD  PLANT  MATRICES  FROM  DISK  FILE 

The  procedure  first  asks  the  data  drive  where  the 
problems  are  stored.  After  this  is  done,  the  program 
calls  another  procedure  called  "Directory"  [Ref.  4]. 
This  procedure  uses  MS-DOS  function,  calls  and  shows 
all  available  data  files  on  the  screen.  The  user  can 
choose  one  of  the  files  by  moving  arrow  keys  with 
< RETURN >  key.  Then  the  program  opens  the  file  and 
reads  it. 

The  directory  displays  only  the  disk  files  with  the 
extension  ".SVS".  This  eliminates  the  possibility  to 
read  other  files. 


1  6 


The  A  matrix  is 


0.0000E+00  1 . 0000E+00  0 . 0000E+00  0 . 0000E+00 
0.0000E+00  0.0000E+00  1.0000E+00  0.0000E+00 
0.0000E+00  0.0000E+00  0.0000E+00  1.0000E+00 
0 . 0000E+00  -1.5000E+01  -2.3000E+01  -9.0000E+00 


The  order  of  the  system  is:4.  Change  ?  (Y/N) 
The  order  of  the  system  is: 3 


The  A  Matrix  is  : 

0 . 0000E+00  1 . 0000E+00  0.0000E+00 
0 . 0000E+00  0.0000E+00  1 . 0000E+00 
0 . 0000E+00  0 . 0000E+00  0 . 0000E+00 


Do  you  want  to  change  any  element  ?  (Y/N) 
Input  row  to  change  :  1 
Input  column  to  change  :  1 


A( 1 ,1 ) =  10 


The  A  Matrix  is  : 

1  . 0000E+0 1  1  . 0000E+00  0 . 0000E+00 
0 . 0000E+00  0 . 0000E+00  1 .0000E+00 
0 . 0000E+00  0.0000E+00  0.0000E+00 


Do  you  want  to  change  any  element  ?  (Y/N) 


III.  GRAPHICS  MENU 


A.  INTRODUCTION  TO  THE  GRAPHICS  MENU 

From  the  opening  menu  of  SVS,  shown  in  Figure  2.1, 
we  choose  the  ”  Graphics  Menu  "  option  to  bring  us  the 
Graphics  menu  shown  in  Figure  3.1.  The  Graphics  menu 
contains  five  basic  options.  These  are  the  time 
response  plot,  Nyquist  plot,  Root  locus  plot, 
characteristic  equation  roots  and  Bode  plot.  This  menu 
is  also  supported  with  the  "Load  plant  matrices  from 
disk  file"  option.  This  selection  allows  the  user  to 
get  data  from  the  disk  file  quickly  instead  of  going 
via  the  SVS  main  menu  route. 


Figure  3.1  The  graphics  menu. 


B.  BODE  PLOT 

Bode  plot  analysis  can  be  accomplished  with  the 
Graphics  menu  by  selecting  the  <B>  Bode  plot  option. 
This  selection  brings  Figure  3.2  to  the  screen.  There 


selections  for 


are  two  selections  for  the  frequency  plot:  the 
open-loop  Bode  plot  and  closed-loop  Bode  plot.  Input 
data  for  this  option  is  entered  with  the  Input/change 
plant  matrices  menu  selection  which  is  explained  in 
Chapter  II.  If  the  user  wants  the  closed-loop  Bode 
plot,  the  program  automatically  calculates  for  the 
negative  unity-feedback  condition. 


Figure  3.2  Bode  plot  parameters  selection 


The  user  also  must  enter  the  starting  frequency  and 
number  of  decades  for  the  plotting.  The  upper 
frequency  limit  is  calculated  based  on  the  number  of 
decades.  That  is,  if  user  selects  .1  as  the  starting 
frequency  with  4  decades,  then  the  upper  frequency  will 
be  1000  rad/sec. 

Bode  plot  displays  two  plots  at  the  same  time. 
These  are  plots  of  magnitude  and  phase  versus  radian 
frequency.  Magnitude  is  converted  to  the  decibels  unit 
using  the  relation 

Magnitude,^  =  20  log! 0(magnitude ) 


.  -•«  .  »  ■/»  -  »  »  j  -*  J  J- 


and  phase  is  converted  to  degrees  using  the  relation 
Phase^ggj.gg  =  (180/tt)  Phase 

Magnitude  calculations  for  the  single  pole  or  zero  can 
be  written  as 

Magnitude  =  [Realpart2  +  ( w-Imaginarypart )2  31/2 
and  the  phase  calculation  is 

Phase  *  Tan"1 [(w-Imaginarypart )/Realpart] . 


For  the  whole  system,  the  magnitude  and  phase  are 
calculated  for  each  pole  or  zero.  Then  the  final 
magnitude  is 


Magnitudesystem  =  Magni tudezeros/Magnitudep0les 


and  the  phase  is 


Phasegyg-tgjjj  *  Phase2eros  “  ^asepoles 

The  plots  of  the  magnitude  and  phase  are  shown  on  the 
same  graph.  Coordinate  values  of  0dB  magnitude  and 
-180°  phase  coincide  in  the  graph.  We  know  from 
control  theory  that  phase  margin  is  read  at  the  zero 
crossover  of  the  magnitude  curve  and  the  gain  margin  is 
read  at  the  -180°  crossover  of  the  phase  curve.  These 
two  values  can  be  read  directly  from  the  graph.  The 
Bode  routine  calculates  the  numbers  required  for  the 
plots.  The  procedure  "plot-Bode"  converts  the  number 
to  a  graphical  display.  Within  the  Bode-plot  routine 
is  a  call  to  the  procedure  "graph-menu".  Graph-menu  is 
called  by  all  procedures  which  produce  a  graph.  It 
provides  a  small  menu  offering  the  laser  the  choice  to 
add  a  title  to  the  graph,  print  the  graph  on  the 


printer,  print  the  number  or  quit  and  return  to  the 
menu . 

If  the  user  selects  the  title  to  graph  and  it  is 
completed,  the  plot  is  displayed  with  the  title  on  the 
screen.  The  title  block  can  be  moved  by  using  the 

cursor  arrow  keys  and  relocated  anywhere  on  the  screen. 
When  the  title  box  is  moved  where  the  user  wants,  the 
<enter>  key  must  be  pressed.  Then  the  screen  is  frozen 
in  position  and  the  graph  menu  is  recalled  on  the 
screen . 

The  print  numbers  selection  saves  the  current 
graphic  screen  and  permits  the  user  to  print  the 
numbers  used  to  draw  the  graph.  The  numbers  may  be 
printed  on  the  printer  (this  will  use  a  lot  of  paper) 
or  to  a  disk  file.  If  the  disk  option  is  selected,  the 
user  can  scan  that  file  with  a  word  processor  or  by 
using  the  DOS  "type"  command  and  examine  the  points  of 
interest.  This  option  is  illustrated  on  example  3.1. 

EXAMPLE  3 . 1 

The  example  can  be  stated  as  follows:  Given  plant 
transfer  function 

100  (  0.02  S  +  1 ) 


( S  +  1 )  (  . 1  S  +  1 )  ( .01  S  +  1 ) 

was  rearranged  as  a  state  variable  equations 


x(  t  )  = 


0 

1 

0 

0 

0 

0 

0 

1 

0 

x(  t )  +  0 

0 

0 

0 

1 

0 

-1 00000 

-1 1 2000 

-12210 

-21  1 

1 

y(t)  =  10000000  200000  0  0_!  x ( 


a)  Obtain  the  Bode  diagram  of  the 

b)  Mark  the  following  on  the  Bode 
the  numerical  values. 

1 )  Gain  crossover  frequency 

2 )  Phase  margin 

3)  Phase  crossover  frequency 

4 )  Gain  margin 

5)  Resonant  frequency. 

Solut ion : 

Given  data  entered  to  the  progr 
of  the  "Input  Plant  Matrices 

input /Change  menu.  Then  the  nro 


Figure  3.4  Closed  loop  Bode  plot  for  example  3.1. 


C.  TIME  RESPONSE  PLOT 

It  is  desirable  to  see  the  system’s  response  in  the 
time-domain  to  a  typical  input.  Time  response  can  be 
calculated  and  plotted  with  the  SVS  program  as  can  the 
system  input  sinusoid,  ramp,  step  or  impulse.  All 
these  inputs  have  user  selectable  amplitudes.  Figure 
3.5  shows  the  time  response  parameter  screen. 

The  time  response  algorithm  first  converts  the  A,  B 
and  C  matrices  to  the  open  loop  transfer  function,  then 
into  a  discrete-time,  state-space  equivalent.  The 
theory  of  the  time  response  plot  is  not  included  here. 
Users  who  want  more  information  about  the  subject 
should  consult  reference  4,  or  any  other  relevant 
textbooks . 


EXAMPLE  3.2 

For  the  given  system  in  example  3.1,  obtain  the 
time  response  plot  and  mark  the  following  on  the  time 
response  plot,  recording  the  numerical  values. 


1 )  Settling  time 

2)  Maximum  overshoot  for  a  step  input. 


Solution : 

The  program  data  has  already  entered  for  the  Bode 
plot.  The  selecting  "Time  response  Plot"  in  the 
graphics  menu  gives  figure  3.6  as  a  problem  solution. 


Time  Response  Plotting  Parameters  *** 

What  is  your  input  to  the  system?  STEP  (S)  S 

RAMP  (R) 

SINE  WAVE  (W) 

IMPULSE  ( I ) 

What  is  your  input  amplitude?  1 

Input  one  of  these  choices.  Open  (0)  or  Closed  (C)  C 

Input  your  simulation  time  to  the  system  (99max)  1.4 


Figure  3.5  Time  response  parameters  screen. 


D.  NYQUIST  PLOT 

This  section  presents  the  Nyquist  plot  option. 
This  selection  gives  open  loop  and  unity-feedback 
closed  loop  Nyquist  plot.  The  program  first  calculates 
open  loop  transfer  function  of  the  plant.  Then  the 
plot  is  obtained  by  calculating  the  magnitudes  and 
phases  angle  of  the  transfer  function  for  a  specified 


Figure  3.6  Time  response  plot  for  example  3.2. 


number  of  times  with  a  specified  increment  of  w. 
Before  proceeding  to  the  Nyquist  plot,  the  program 
prompts  the  menu  of  Figure  3.7.  This  parameters  screen 
allows  the  user  to  enter  additional  data  for  the 
plotting.  The  graphic  window  size  is  given  100X100 

scale  if  the  user  selects  the  big  picture  option.  The 
select  own  size  option  asks  the  user  to  enter  starting 
frequency,  number  of  decades  and  X,Y  coordinates 
maximum  and  minimum  values  for  the  plot.  After  getting 
the  plot,  the  procedures  are  the  same  as  with  the  Bode 
plot  option.  These  are  make  a  title  to  the  graph, 

printer  output  and  listing  numbers  (which  are  used  to 
generate  a  graph)  either  to  the  printer  or  a  specified 
file  with  a  given  drive  name. 
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**M*  Nyquist  Plotting  Parameters  *** 


Open  (0)  or  (C)  Closed  loop  plot?  0 

Graph  window  (B)  or  (S)  Select  your  own  size?  S 

Input  your  first  frequency  to  be  plotted?  .1 

(Example:  .01,  1,  100,  etc.  ) 

Input  number  of  decades  do  you  want  plotted?  4 

X -Maxi mum  1 00 

X-Minimum  -100 
Y-Maximum  1 00 
Y-Minimum  -100 

Any  changes  to  these  parameters?  (  Y  /  N  )  N 
Press  <F1 >  to  change  previous  entry 


Figure  3.7  Parameters  selection  for  the  Nyquist  plot. 
EXAMPLE  3.3 

Figure  3.8  shows  the  Nyquist  plot  for  the  example 
3.1  A,  B  and  C  matrices. 


Figure  3.8  Example  of  the  Nyquist  plot. 


•W.- 


***  Boot  Locus  Plotting  Parameters  *** 

Input 

STARTING  value 

for  the  varying  gain 

0 

Input 

ENDING  value  for  the  varying 

gain 

1  0 

X-Minimum 

-100 

X -Maximum 

1  00 

Y-Minimum 

-100 

Y -Maxi mum 

1  00 

Positive  or  Negative 

feedback?  (  P 

/  N  ) 

N 

Any  changes  to  these 

parameters? 

N 

Figure  3.10  Example  for  the  root  locus  plot 


F.  CHARACTERISTIC  EQUATION  ROOTS 

This  option  of  the  graphics  menu  allows  the  user  to 
decide  whether  the  system  is  stable  or  unstable  by 
looking  at  the  root  location  of  the  characteristic 
equation.  The  program  gives  again  the  unity-feedback 
closed  loop  characteristic  equation  roots  of  the  plant. 
The  illustrative  program  output  of  the  example  3.1  can 
be  seen  in  Figure  3-11. 

G.  LOAD  PLANT  MATRICES  FROM  DISK  FILE 

This  last  option  of  the  graphics  menu  allows  the 
user  to  get  saved  data  from  disk  file  directly  instead 
of  going  via  to  the  main  menu  and  input/change  menu. 


***  Plant  Characteristic  Equation  Soots 


M  *»  M 


ROOTS  OF  THE  NUMERATOR 
s[l]=  -50.00  +j  0.000 
ROOTS  OF  THE  DENOMINATOR 

s[1]«  -132.032  +j  0.000  s [2] =  -69.170  +J  0.000 
s[3]=  -4.899  +j  -32.893  s[4]  =  -4.899  +J  32.899 

Figure  3.11  Example  of  characteristic  equation 

roots . 


IV.  SVS  MAIN  MENU 


A.  INTRODUCTION  TO  THE  SVS  MAIN  MENU 

In  this  chapter  six  options  are  presented  which  may 
be  used  for  the  analysis  and  design  of  control  systems. 
These  options  are  supported  by  the  other  options  which 
are  explained  in  Chapter  II  and  III. 

The  observability  option  is  used  to  determine  the 
observability  index  of  the  system.  Another  very 
similar  program,  controllability  is  used  to  determine 
the  controllability  of  the  system.  The  matrix 
mathematics  option  brings  to  the  screen  another  menu 
selections.  This  program  calculates  an  A  matrix 
determinant,  inverse,  characteristic  polynomial  and 
eigenvalues.  The  last  three  options  may  be  used  to 
design  optimal  linear  control  systems.  The  pole 
placement  option  is  useful  in  the  design  of  linear 
control  state  variable  feedback  control  systems.  In 
the  pole  placement  case,  the  control  is  computed  by 
multiplying  by  a  gain  [K] ,  the  difference  between  the 
reference  input  and  a  weighted  (linear)  sum  of  the 
state  variables.  The  Luenberger  observer  design  is 
used  to  design  a  combined  observer-controller  to 
achieve  a  given  desired  closed  loop  transfer  function 
when  some  of  the  states  are  not  accessible. 

Design  of  optimal  control  will  minimize  a  given 
cost  function  which  produces  a  scalar  control.  The 
program  starts  to  work  at  the  terminal  time  and  works 
backwards  in  time. 

B.  CONTROLLABILITY 

This  option  is  used  to  determine  the 
controllability  of  the  linear  time-invariant  system. 
Consider  the  following  continuous-time  system 


x(t)  *  A  x(t)  +  B  u(t)  (4-1) 

where 

x  =  state  vector 
A  =  plant  matrix 
B  =  input  matrix 
u  =  control  input 

The  system  described  by  the  above  equation  is  said 
to  be  state  controllable  at  a  given  initial  time  if  it 
is  possible  to  construct  an  unconstrained  control 
signal  which  will  transfer  an  initial  state  to  any 
final  state  in  a  finite  time  interval  [Ref.  5]. 

This  requires  an  algebraic  condition  such  that  the 
rank  r(C)  of  the  controllability  condition  matrix 

C  =  [B! AB! . . . . !An-1B]  (4-2) 

is  n,  the  order  of  the  system. 


EXAMPLE  4 . 1 

Consider  the  matrices  A  and  B, 


0 

1 

-1 

1 

0 

1 

0 

1 

9 

B  = 

0 

1 

0 

1 

-1 

0 

0 

Determine  if  [A, 


B]  is  a  controllable  pair. 


Solution :  Since  A  is  3x3  and  B  is  3x2,  matrix  C  has  to 
be  3x6.  The  program  checked  the  rank  of  the 
controllability  condition  matrix.  The  result  of  the 
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program  can  be  seen  in  Figure  4.1  ,  the  system  is 
controllable . 


CONTROLLABILITY  RESULT 

The  Plant  matrix  A  is  : 

0 . 00000E+00 

1  .  00000E+00  -1  . 0000E+00 

1 . 00000E+00 

0 . 00000E+00  1 . 00000E+00 

0 . 00000E+00 

1 . 00000E+00  - 1 . 0000E+00 

The  input  Matrix  B  is  : 

1  . 00000E+00 

0 . 00000E+00 

0 . 00000E+00 

1 . 00000E+00 

0 . 00000E+00 

0 . 00000E+00 

The  system  is 

controllable . 

Figure  4.1  Controllability  program  output. 


C.  OBSERVABILITY 

In  this  section  we  determine  observability  index  of 
the  linear  systems.  Consider  the  unforced  system 
described  by  the  following  equations: 

The  (unforced)  time  invariant  system 

x  *  Ax  (4-3) 

with  the  observation  vector 

y  *  Cx  (4-4) 

The  observability  index,  which  is  defined  as  the  rank 
r(0)  of  the  observability  condition  matrix 


0  = 


C 

CA 


CAn~  1 


(4-5) 


is  n,  the  order  of  the  system. 


this 


The  program  output  for  this  selection  is 
illustrated  in  Figure  4.2  with  the  A  matrix  as  given  on 
example  4.1  and  the  following  C  matrix. 


OBSERVABILITY  RESULT 

The  Plant  matrix  A  is  : 

0 . 00000E+00 

1 . 00000E+00 
0 . 00000E+00 

1  .  00000E+00 

0 . 00000E+00 

1  .  00000E+00 

-1 
1  . 
-1 

. 0000E+00 
0000  0E+00 
. 0000E+00 

The  Output  Matrix  C  is  : 

1 . 00000E+00 

0 . 00000E+00 

0. 

00000E+00 

The  system  is 

observable  with 

index  3. 

Figure  4.2  Observability  program  output 


D .  POLE  PLACEMENT 

Any  single-input  single-output  linear,  time 
invariant  system  is  described  by  the  following 
equations : 

x(t)  =  A  x(t)  +  B  u(t)  (4-7) 

y(t)  =  C  x(t)  ( 4-8 ) 

The  plant  is  characterized  as  a  block  diagram  in 
Figure  4.3. 


'4^*4, 


r(  t ) 


Figure  4.3  Block  diagram  for  the  state  variable 
representation . 


The  closed  loop  nature  of  the  system  of  Figure  4.4 
is  showed  by  the  presence  of  the  controller.  It 
generates  the  control  signal  u  from  the  knowledge  of 
the  state  variables.  So,  we  can  see  that,  except  for 
the  reference  input  [r] ,  the  state  of  the  plant  x  is 
the  only  information  needed  by  the  controller.  The 


PLANT 


CONTROLLER 


t, 


control  input  is  computed  by  the  multiplying  by  a  gain 
K  the  difference  between  the  reference  input  and  a 
weighted  (linear)  sum  of  the  state  variables.  As  a 
mathematical  expression, 

u=  K  [  r  -  (  k-jx-j  +  k2x2  +  ....  +  knxn  )]  (4-9) 

where  the  ’ s  are  referred  to  as  feedback 
coefficients.  The  gain  K  is  referred  to  as  the 
controller  gain.  The  equation  (4-9)  may  be  simplified 
by  making  it  in  the  matrix  notation 


u=  K  [  r  -  kT  x  ] 


(4-10) 


After  all  this  notation,  the  graphical  representation 
of  the  system  configuration  is  shown  in  Figure  4.5. 


PLANT 


u=K [r-kTx] 


We  could  obtain  the  closed  loop  transfer  function 
Y(s)/R(s)  from  the  state  variables.  Our  approach  is  to 
force  the  system  into  the  configuration  shown  in  Figure 


Gp(s) 


Hr n ( s  ) 


Figure  4.6  Closed  loop  block  diagram  representation 


We  can  see  that  Heq(s)  is  given  by 

Since  y(s)=  C  x(s),  this  expression  becomes 


Here  it  must  be  pointed  out  that  the  program 
calculates  the  gain  K,  so  zero  steady  state  error 
results  from  a  step  input.  If  the  user  wants  other 
conditions,  he  may  rescale  K  and  kT  appropriately  by 
hand.  For  example,  assume  he  wants  to  desire  to  have 
the  controller  gain,  K=K-|  ,  but  the  program  output  shows 
that  K  =  Kg  with  the  feedback  coefficients  k-j  ,  k2 ,  kj, . 
The  procedure  is  then  to  modify  the  program  outputs  by 
setting  K  =  K-j  and  setting 


*T"  “5T  [  “2  *3  ] 

This  procedure  does  not  change  Y(s)/R(s)  and  satisfies 
the  condition  K=K-|  .  Under  these  notations  and  block 
diagrams,  this  option  gives  an  open  loop  transfer 
function  Y(s)/U(s)  for  the  plant,  the  feedback  transfer 
function  Heq(s),  the  controller  gain  [K]  and  the 
feedback  coefficients  [k-^]  to  achieve  the  desired 
closed  loop  characteristic  polynomial. 

The  desired  closed  loop  characteristic  polynomial 
is  the  denominator  of  Y(s)/R(s)  and  must  agree  with  the 
order  of  the  plant.  The  user  can  enter  this  polynomial 
either  in  coefficient  form  or  factored  form.  If  the 
user  wants  to  enter  the  coefficient  form,  the 
coefficient  of  the  highest  degree  term  must  be  unity. 

The  methodology  for  computing  the  result  is:  the 
coefficients  of  the  denominator  polynomial  of 
Y(S)/R(s),  which  is  the  polynomial  desired  by  the  user, 
may  be  adjusted  at  will  by  proper  selection  of  k  and  K. 
The  closed  loop  zeros  are  equal  to  the  open  loop  zeros. 
In  other  words,  linear  state  variable  feedback  has  no 
effect  on  the  zeros  of  Y(s)/R(s).  The  program 
calculates  the  numerator  of  Heq(s)  to  achieve  the 
desired  characteristic  polynomial.  Note  that  the 
complete  Heq(s)  is  calculated  by  talcing  the  numerator 
of  Heq(s)  and  dividing  it  by  the  numerator  of 
Y(s)/U(s).  In  the  program  procedures,  the  coefficients 
of  the  characteristic  polynomial  are  computed  by  the 
use  of  the  Principle-Minor  method.  For  the  matrix 
inverse  calculation,  the  program  uses  the 
diagonal izat ion  procedures. 

EXAMPLE  4 . 1 

The  plant  matrices  of  a  third  order  system  are 
given  in  the  following  state  variable  representation: 


i 


| 
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x(  t  )  = 


-1 

0 

1  .0 

0.0  ~ 

0 

0 

0 

0 . 0 

1  . 0 

x(  t )  + 

0 

0 

0 

-3.0 

0 . 0 

1 

y( t )  =  [  1.0  1.0  0.0  ]  x(t ) 


(4-15) 


Find  the  feedforward  (controller)  gain  [K]  and  the 
feedback  coefficients  [kT]  required  to  achieve  a  closed 
loop  transfer  function  of 


Y(s) 

R(s) 


2  (s  +  2) _ 

S3  +  4s2  +  6s  +  4 


(4-16) 


The  program  result  for  this  example  is  presented  in 
Figure  4.7. 


POLE  PLACEMENT  RESULT 
The  Plant  matrix  A  is  : 

—1 . 0000E+00  1 . 00000E+00  0 . 00000E+00 

0 . 00000E+00  0 . 00000E+00  1 . 00000E+00 

0 . 00000E+00  -3 . 0000E+00  0 . 00000E+00 

The  Input  matrix  B  is  : 

0 . 00000E+00 
0 . 00000E+00 
1 . 00000E+00 

The  Output  Matrix  C  is  : 

1 . 00000E+00  1 .00000E+00  0 . 00000E+00 

Denominator  of  Y(s)/U(s)  -  Descending  powers  of  S 
1 .0000  1 .0000  3.0000  3.0000 


The  poles 

of  the  Y(s)/U(s)  are 

: 

REAL  PART 

IMAGINARY  PART 

- 1 .0000 

+  3 

0.0000 

0 . 0000 

+3 

-1 . 7321 

0.0000 

+3 

1 . 7321 

Numerator 

of  Y(s)/U(s)  -  Descending  powers  of  S  : 

1  .0000 

2 . 0000 

The  zeros 

of  the  Y(s)/U(s)  are: 

REAL  PART 

IMAGINARY  PART 

-2 . 0000 

+3 

0 . 0000 

Desired  closed-loop  Character! 

Descending  powers  of  S  : 

Stic 

polynomial  - 

1 .0000 

4 . 0000  6.0000 

4 

.  0000 

The  roots 

of  desired  closed-loop  characteristic 

polynomial  are: 

REAL  PART  IMAGINARY  PART 

-2.0000  +j 

0 

.0000 

-1  .  0000  +j 

-1 

.0000 

-1  .  0000  +j 

1 

.0000 

Numerator 

of  the  Heq(s)  is  -  Descending  powers  of  S  : 

1  .5000 

1.5000  0.5000 

The  roots 

of  the  Heq(s)  are  : 

REAL  PART 

IMAGINARY  PART 

-0.5000  +j 

- 

0.2887 

-0.5000  +j 

0.2887 

The  feedback  coefficients  [kT] 

are 

: 

0.5000 

0 . 0000  1 .5000 

The  gain 

[K]  is  :  2.0000 

Figure  4.7  Program  output  for  the  pole  placement 
( continued ) 

The  results  shown  in  Figure  4.7  specify  that  the 
gain  of  the  controller  [K]  is  2.0  and  the  feedback 
coefficients  are  ki=0.5,  k?=0.0  and  k-*  =  1.5. 


E.  LUENBERGER  OBSERVER  DESIGN 


Consider  a  linear  time  invariant  plant  of  the  form 

x(t)  =  A  x ( t )  +  B  u(t)  (4-17) 

y(t)  =  C  x(t)  (4-18) 

Let  a  feedback  control  law  for  equations  (4-17)  and 
(4-18)  will  be 

u(t)  =  K  [  r ( t )  -  kT  x ( t ) ]  (4-19) 


PLANT 


Figure  4.8  Luenberger  observer  block  diagram. 


Assume  without  loss  of  generality  that  the  plant  is 
controllable  and  observable.  Since  the  state  of 
equation  (4-17)  is  not  directly  available  to  implement 
equation  (4-19),  an  observer  of  the  form 

z(t)=  F  z(t)  +  G-]  y(t)  +  G2  u  ( t )  (4-20) 

and  replacing  the  true  states  with  estimates  yields 

u(t)=  K  [  r(t)  -  kT  z ( t  )  ]  (4-21) 

kTz(t)=  hT  z ( t )  +  qT  y(t)  (4-22) 

will  be  designed.  The  resulting  closed  loop  system  is 
shown  in  Figure  4.8. 
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Where 


x 


state  vector 
control  input 


u  = 
y  =  output 

r  =  system  forcing  input 
z  =  estimated  state  vector 
A  =  plant  matrix 
B  =  input  matrix 

F  =  observer  eigenvalues  matrix 
G-]  and  G2  =  observer  gain  matrices 
K  =  controller  gain 

q1^  =  output  feedback  coefficients  matrix 
hT  =  observer  feedback  coefficients  matrix 


*****  Luenberger  Observer  Design  Parameters 

M  M  « 

Input 

degree  of  observer  (10  max)  2 

Input 

the  desired  feedback  coefficients  in 

Factored 

<F> 

Form  C 

or  Coefficient 

<C> 

Form 

Input 

observer  characteristic  polynomial 

in 

Factored 

<  F> 

Form  C 

or  Coefficient 

<C> 

Form 

Press 

<ESC>  to  change  it!, 

Then 

type  your  input  with  <ENTER>  key 

Figure  4.9  Luenberger  observer  design  parameters. 


The  user  has  to  enter  the  controller  gain  and  the 
feedback  coefficients  which  can  be  found  by  the  use  of 


"pole  placement"  option.  The  program  asks  the  observer 
eigenvalues  which  are  represented  by  the  F  matrix  in 
the  program.  The  observer  degree  depends  on  the 
observability  index.  For  example,  if  the  observability 
index  r  is  the  minimum  integer,  then  the  observer  gain 
matrix  [G]  has  order  r.  Simply  the  order  of  the 
observer,  when  the  program  prompted  cam  be  entered.  As 
equal  to  or  greater  than  (r-1).  These  input  parameters 
are  shown  in  Figure  4.9. 

EXAMPLE  4.2 

The  example  presented  here  for  the  fourth  degree 
plamt  is  taken  from  Desjardin’s  [Ref.  2].  The  plant  is 
represented  by  the  following  equations. 


y ( t )  =  [  10  20  0  0  ]  x ( t ) 


(4-23) 


x(  t )  = 


0 

1 

0 

0 

0_ 

0 

0 

1 

0 

x(  t )  + 

0 

— 

0 

0 

0 

1 

0 

0 

-15 

-23 

-9 

1 

u(t ) 


(4-24) 


Solution : 

Step  1 

The  x-j  and  X2  are  the  only  measurable  states  and  we 
want  to  achieve  following  closed  loop  transfer 
funct ion . 


The  controller  gain  [K]  and  the  feedback 
coefficients  required  are  found,  as  can  be  seen  from 
Figure  4.10  by  the  use  of  the  "Pole  placement"  option 
in  the  same  menu.  Results  shown  in  Figure  4.10 
indicates  that  the  feedback  coefficients  [kT]  are  -3, 
-6,  13,  20  and  the  controller  gain  [K]  equals  unity. 

POLE  PLACEMENT  RESULT 
The  Plant  matrix  A  is  : 

0.00000E+00  1.00000E+00  0.00000E+00  0.00000E+00 

0.00000E+00  0.00000E+00  1.00000E+00  0.00000E+00 

0.00000E+00  0.00000E+00  0.00000E+00  1 .00000E+00 

0 . 00000E+00  -1 . 5000E+0 1  -2.3000E+01  -9.0000E+00 

The  Input  matrix  B  is  : 

0 . 00000E+00 
0 . 00000E+00 
0 . 00000E+00 
1 . 00000E+00 

The  Output  Matrix  C  is  : 

2 . 00000E+0 1  1 . 00000E+0 1  0 . 00000E+00  0 . 00000E+00 

Denominator  of  Y(s)/U(s)  -  Descending  powers  of  S  : 

1 .0000  9.0000  23.0000  15.0000  0.0000 

Numerator  of  Y(s)/U(s)  -  Descending  powers  of  S  : 

20 . 0000 

Desired  closed-loop  Characteristic  polynomial  - 
Descending  powers  of  S  : 

1 .0000  6.0000  17.0000  28.0000  20.0000 

Numerator  of  the  Heq(s)  is  -  Descending  powers  of  S  : 

-3.0000  -6.0000  13.0000  20.0000 

The  feedback  coefficients  [  k  ]  are  : 

20.0000  13.0000  -6.0000  -3.0000 

The  gain  [  K  ]  is  :  1  .0000 


The  observability  index  is  determined  using  the 
"Observability"  option  in  the  same  menu.  That  results 
is  shown  in  Figure  4.11. 

OBSERVABILITY  RESULT 
The  Plant  matrix  A  is  : 

0 . 00000E+00  1 . 00000E+00  0 . 00000E+00  0 . 00000E+00 

0 . 00000E+00  0 . 00000E+00  1 . 00000E+00  0 . 00000E+00 

0 . 00000E+00  0 . 00000E+00  0 . 00000E+00  1 . 00000E+00 

0 . 00000E+00  - 1 . 5000E+0 1  -2 . 3000E+0 1  -9 . 0000E+00 

The  Output  Matrix  C  is  : 

1 . 00000E+00  0 . 00000E+00  0 . 00000E+00  0 . 00000E+00 

0 . 00000E+00  1 . 00000E+00  0 . 00000E+00  0 . 00000E+00 

The  system  (A,C)  is  observable  with  index  3. 

Figure  4.11  Observability  result  for  Luenberger . 


Step3 

As  can  be  seen  from  Figure  4.12,  the  system  is 
completely  controllable. 


CONTROLLABILITY  RESULT 

The  Plant  matrix 

A  is  : 

0.00000E+00  1 . 
0.00000E+00  0. 
0.00000E+00  0. 
0 . 00000E+00  -1 

00000E+00 
00000E+00 
00000E+00 
. 5000E+0 1 

0 . 00000E+00 

1 . 00000E+00 

0 . 00000E+00 
-2 . 3000E+0 1 

0 . 00000E+00 

0 . 00000E+00 

1  .  00000E+00 
— 9 . 0000E+00 

The  input  Matrix 

Bis  : 

0 . 00000E+0  0 

0 . 00000E+00 

0 . 00000E+00 

1 . 00000E+00 

The  system  (A,B) 

is  controllable. 

Step4 


An  observability  index  r=3  (result  taken  from 
observability  output)  allows  us  to  design  an  observer 
of  order  equal  to  or  greater  than  (r-1)=2.  For  this 


LUENBERGER  OBSERVER  RESULT 
The  plant  matrix  A  is  : 

0 . 00000E+00  1 .00000E+00  0.00000E+00  0 . 00000E+00 


0 . 00000E+00  0.00000E+00  1 . 00000E+00 
0 . 00000E+00  0.00000E+00  0.00000E+00 
0 . 00000E+00  - 1 . 5000E+0 1  -2 . 3000E+0 1 


0 . 00000E+00 
1  .  00000E+00 
-9 . 0000E+00 


The  input  matrix  B  is  : 

0 . 00000E+00 
0 . 00000E+00 
0 . 00000E+00 
1  .  00000E+00 

The  output  Matrix  C  is: 

1 . 00000E+00  0 . 00000E+00  0 . 00000E+00  0 . 00000E+00 

0 . 00000E+00  1 . 00000E+00  0 . 00000E+00  0 . 00000E+00 

The  desired  feedback  coefficients  are  : 

2 . 00000E+0 1 
1 . 30000E+0 1 
-6 . 0000E+00 
-3 . 0000E+00 

The  Observer  characteristic  polynomial  coefficients 
in  ascending  powers  of  S 

1 .40000E+01  7.50000E+00  1 .00000E+00 


The  F  Matrix  is 


-7 . 5000E+00 
- 1 . 4000E+0 1 


1  . 00000E+00 
0 . 00000E+00 


The  G1  Matrix  is  : 

8 . 55000E+0 1  2 . 92500E+0 1 

0.00000E+00  0.00000E+00 

The  G2  Matrix  is  : 

—3 . 0000E+00 
-1 . 5000E+00 

The  output  feedback  coefficients  are  : 

2.00000E+01  8.50000E+00 

The  compensator  feedback  coefficients  are  : 
1 . 00000E+00  0.00000E+00 


Figure  4.13  The  Luenberger  observer  design  output 
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example,  we  want  to  design  observer  eigenvalues  of 
-3 . 5  and  -4.0. 


Step5 

The  program  results  for  all  this  input  data  is 
shown  in  Figure  4.13.  From  results,  the  complete 
system  can  be  described  as: 


x(  t  )  = 


0.0  1.0  0.0  0.0 

X-j  ( t ) 

0 

0.0  0.0  1.0  0.0 

x2(  t ) 

4. 

0 

0.0  0.0  0.0  1.0 

x5(  t ) 

T 

0 

0.0  -15.  -23.  -9. 

X4.  ( t ) 

1 

u(  t ) 


z(  t  )  = 


-7.5 

-1  .0 

z3(  t ) 

4_ 

85.5 

29.25 

X-|  ( t ) 

*3* 

1 

0 . 0 

z4(  t ) 

1 

0 . 0 

0 . 0 

x2(  t ) 

■3.0 
■1  .5 


u(  t ) 


u(t)  =  1.0  r  ( t  )  -  [  20.0  8.5]  Qjlj^y| 

-  c,-a  -0]  [i?m] 


F.  DESIGN  OF  OPTIMAL  CONTROL 

The  system  considered  is  described  by  the  following 
state  variable  equation: 


x(t)  =  A  x(t)  +  B  u(t) 


( 4-26) 


where 


x  =  state  vector 
u  =  control  input 
A  =  plant  matrix 


. . . ; 
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B 


input  matrix 


The  design  of  optimal  control  will  minimize  the 
following  cost  function: 


J(N) 


1  / 2 [  XT ( N )  Q  X ( N ) 


+ 


N-  1 

n  [X ( k )  Q  X ( k )  +  R  U2(k)] 
k=0  (4-27) 


where  the  following  are  defined 

Q  =  noise  covariance  matrix 

N  =  time  intervals  over  which  the  SUM  is  made 
R  =  scalar  random  input 
and  XT  means  transpose  of  X. 

The  physical  interpretation  of  J(N)  is  this:  we 
wish  to  keep  the  state  near  zero  without  excessive 
control  energy  expenditure.  The  input  parameters  of  the 
design  of  optimal  control  are  entered  in  the  beginning 
of  the  program.  This  screen  can  be  seen  in  Figure 
4.14.  After  entering  these  parameters  and  the  Q 
matrix,  then  the  program  calculates  the  feedback  gain 
matrix  which,  when  multiplied  by  the  state  vector, 
yields  a  scalar  control.  In  the  program  procedures, 
the  following  equations  were  derived  using  dynamic 
programming,  starting  at  the  terminal  time  and  working 
backwards . 


P( k )  =  PSIT ( k )  *  P( k-1  )  *  PSI(k)  +  Q  +  GT ( k )  * 

R  *  G(k),  P(0)=0 

PSI ( k ) =FI  +  GAMMA  »  GT ( k ) ,  PSI(0)  =  0 

GT ( k ) = - [ GAMMAT  *  P(k-1)  *  FI ] / [ GAMMAT  *  P(k-1)  * 

GAMMA  -l-  Rl  ,  GT (  0  )  =  0 


(  4-28) 
(4-29) 

(4-30) 


#**  Design  of  optimal  control  procedure 

Input  number  of  time  intervals  for  SUM  procedure?  40 
What  is  your  sample  interval?  0.1 

What  is  the  value  of  scalar  R?  2.0 

For  the  following  options  which  cost  function 

do  you  want?  0 

COST= terminal+fuel+traj ectory  or 
COST=terminal+tr aj ectory  <0> 

COST= terminal+fuel  or  COST= terminal  <1> 
where 

terminal =  1/2  XT(N)  Q  X(N) 

N- 1 

trajectory=  1/2^  X(  k )  Q  X(k) 

k  =  0 
N-1 

fuel  =  1  / 2  YZR  U2(k) 
k  =  0 

Press  <ESC>  to  change  it!. 

Then  type  your  input  with  < ENTER >  key 


the  system  equation  and.  parameters  described 


the  discrete  steady  state  gains  for  a  sample 
0.1,  scalar  R  is  1.0  and  number  of  time 


brings  the  matrix  mathematics  menu.  This  second  menu 
consist  of  following  options: 

(1)  The  determinant  of  A  matrix 

(2)  The  inverse  of  A  matrix 

(3)  The  characteristic  polynomial  of  A  matrix 

(4)  The  Eigenvalues  of  A  matrix 

Before  selecting  this  option,  the  user  must  select 
" Input /Change  Plant  Matrices"  option  to  enter  the 
plant  matrices. 


Figure  4.16  Optimal  control  graphic  output  U 2 . 
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OPTIMAL  CONTROL  RESULT 

The  order  of  the  system  is  :  2 
The  number  of  time  intervals  is  :1.0E-01 
The  scalar  R  is  :  1 .0000 

The  sample  interval  is  :  40 

The  A  matrix  is: 

0.00000E+00  1 .00000E+00 

5.00000E+00  0.00000E+00 

The  B  matrix  is: 

0 . 00000E+00 
1 . 00000E+00 

The  Q  matrix  is: 

1 .00000E+00  0.00000E+00 

0.00000E+00  2.00000E+00 

The  FI  matrix  is: 


1.02510E+00  1 . 00835E-0 1 

5 • 04 1 77E-0 1  1 .0251 0E+00 


The 

GAMMA  matrix  is: 

5. 

02087E-03 

1  . 

00835E-01 

MINIMIZATION  OVER  ALL 

STAGES 

(stages)  GT:2 

GT :  2 

1 

-1 . 047E-0 1 

-2 . 031E-01 

2 

-3 .243E-01 

-4.21  IE-01 

3 

-6 . 722E-0 1 

-6 . 665E-01 

4 

-1.1 64E+00 

-9 . 495E-01 

5 

-1 . 809E+00 

-1 . 275E+00 

6 

-2 . 597E+00 

-1 . 640E+00 

7 

-3 . 494E+00 

-2.031 E+00 

8 

-4 . 437E+00 

-2 . 424E+00 

9 

-5 . 355E+00 

-2 . 794E+00 

1  0 

-6 . 185E+00 

-3 . 1 20E+00 

1  1 

—■6 . 888E+00 

-3 . 390E+00 

1  2 

-7 . 452E+00 

-5 . 603E+00 

1  3 

-7 . 886E+00 

-3 . 765E+00 

1  4 

-8. 21 0E+00 

—  3 . 883E+00 

15 

-8. 447E+00 

-3 . 969E+00 

1  6 

-8. 61 7E+00 

-4 . 030E+00 

17 

-8 . 738E+00 

-4 . 073E+00 

18 

-8 . 824E+00 

-4 . 1 04E+00 

1  9 

-8 . 884E+00 

-4 . 1 25E+00 

20 

-8 . 927E+00 

-4 . 1 40E+00 

21 

-8 . 957E+00 

-4 . 1 50E  +  00 

22 

-8. 978E+00 

-4 . 1 57E+00 

23 

-8. 993E+00 

-4 . 1 63E+00 

24 

-9 • 004E+00 

-4 . 1 66E+00 

25 

-9.011 E+00 

-4 . 1 69E+00 

26 

-9.01 6E+00 

-4 . 1 70E+00 

27 

-9 . 020E+00 

-4 . 1 72E+00 

28 

-9 . 023E+00 

-4 . 1 73E+00 

29 

-9 . 025E+00 

-4 . 1 73E+00 

Figure  4.17  Optimal  control  numerical  output 
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V.  CONCLUSION  AND  RECOMMENDATIONS 


The  software,  SVS,  is  written  as  a  teaching 
learning  tool  for  student  use.  It  can  be  a  nice  tool 
for  analysis  and  design  of  linear  control  state 
variable  systems.  The  program  is  fully  interactive  and 
menu  driven.  The  user  does  not  get  lost  in  the 
program.  The  <Q>  key  always  returns  to  the  main  menu 
or  CTRL  +  C  key  interrupts  the  program.  All  options 
were  tested  solving  several  example  problems. 
Hopefully,  all  "bugs"  have  been  eliminated. 

Furthermore,  the  program  can  still  be  easily 
improved  and  expanded.  These  are  listed  below. 

(1)  Adding  the  ability  to  handle  the  KALMAN 
filtering . 

(2)  Add  the  capability  of  the  program  to  handle 
discrete  time  systems. 
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APPENDIX  A 


UTILITI  FILES 

A  set  of  Turbo  Pascal  input  and  menuing  utilities 
was  used  widely  in  the  program.  These  are  public  domain 
utilities  and  was  copied  from  the  LCS-CAD  source 
diskettes.  These  utilities,  called  TURBO-UT.PAS  were 
written  by: 

Donald  R.  Ramsey 
Larry  Romero 
727  Bunker  Hill  #70 
Houston,  Texas  77029 

and  distributed  through  the  public  domain.  The 
describing  documentation  are  presented  on  reference  4. 


APPENDIX  B 


PROGRAM  LISTING 

Appendix  B  is  a  listing  files  of  the  Turbo  Pascal 
source  code.  These  files  make  up  the  major  modules  of 
the  SVS  program.  In  general,  most  of  the  driver 
programs  and  including  files  are  listed  in  the 
following  pages.  The  source  modules  from  the  Borland 
International  Turbo  Graphix  Toolbox  and  the 
input/output  utility  routines  are  not  listed. 


FILE:  SVS.PAS 


Program  Listing 

Program  State  Variable  System( input , output )  ; 

(*  The  following  include  files  contain  procedures  *  ) 
V „  to  handle  graphics  call  from  the  main  procedures*) 
C*  of  this  program.  These  include  files  are  a  part  *) 
\ *  of. Borland  International’s  Turbo  Graphix  Toolbox*) 
(*  Which  is  a  commercially  available  product.  *) 


Page 


($1  Typedef,SYS) 
($1  Box . INC \ 


•a#####*######*##*#*##########*# 

(type  &  variable  decleration) 
(draw  the  box  for  the  main  menu) 


#*###########*##############*################# 
These. are  utility  procedures  and  functions  to 


help  input.  They  are  public  domain  programs 
I  Ut-Mod02  :  INci  <I/0  Pr°cedures> 


($1  Ut-Mod0 1 . INC 
($1  Ut-Mod02 . INC 


(I/O  procedures) 


Procedure  MainMenu; 
var 

I,  Tab 


Integer ; 


Description 

Okchoices 


File  : 
Str80 ; 
Set  Of 


Char 


procedure  ProgramExit; 

be  (Displays  warning  about  program  end) 

§lrscr;  Highvideo; 

Msg( ’Have  vou  wanted  ending  the  SVS  program?  (  Y/N 

LowVideo; 

Repeat 
option; , 

Untlinch  :So;N’])  then  Beep(900.350) 

End; 

Procedure  Menultem( pick : char : description : str80 ; 

.  _  ,  color : integer ) : 

„  (  allows  easy  selection  of  main  menu  colors) 

Begin 

TextColor (color ) ; 

Write(’  Tab, ’(*),;  TextColor  (white  ):  Write(pick); 
TextColor ( color ) ;  Wr iteln( description ) ; 

&na  f 


Begin  (  Main  Menu  ) 

ClrScr * 

Text Color ( 1 ightblue ) ; 

Msg( Naval  Postgraduate  School  Ismail 

UNLU  ’ ,7,24); 

GoToXY( 2 1 , 4 ) ;  TextColor (white ) ; 

Writeln( ’  ***  SVS  MAIN  MENU  ***  ’)j 

(  show  main  menu  ) 

Wr  iteln(  ’  ’  ) ; 

T  ab  :  =  2  3  * 

Menultem( ’ I ’ , ’ Input  /  Change  Plant  Matrix  Menu’, red); 
Writeln • 

Menu I tem( ’ G ’ , ’ Graphics  Menu ’ , 1 ightgr av ) ; 

Menultemi ’C’ , ’Controllability’ .yellow); 

Menultemi ’ 0 ’ , ’ Observability ’ .yellow) ; 

Menultem( ’ L ’ , ’ Luenberger  Observer  Design ’, yel 1 ow ) ; 


i 
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MenuItemC ’ D ’,’ Design  of  Optimal  Control ’, yel low ) ; 
Menuitem( ’ P ’ , ’ Pole  Placement ’ .yellow) ; 

Writeln ; 

MenuItemC ’ M ’ , ’ Matr ix  Mathematics  Menu ’ , lightgray ) ; 
Writeln ; 

Menultemi ’  H  ’ , ’ Help ’ , light magenta) ; 

MenuItemC ’ Q Quit  the  program 1 lghtmagenta ) ; 

Box; 

if  not  (blockl  in  [1..20]  )  then 

OKchoices:=  [ ’ I ’ ,  ;H ’  .  ’ Q ’ T 
else  OKchoices : = [ ’I,’CZ.’0’.’D’,’M’,’P’, 

’G’ , ’L’ , VH’ , *Q’ ] ; 

Repeat  {sets  legal  choices  depending  on  user) 

Option ; 

If  not  ( ch  in  okchoices)  then 

§extColor (red); 

If  blockl  <=  0  then 
Begin 

lee^  900 , 350  )  ; 


Msg( ’ WARNING :  First 


INPUT  HELP  or  QUIT!’, 
1,25); 


M’ 


End; 

End; Text Co lor (white ) ; 

Until  Ch  in  Okchoices; 

Case  Ch  of 
’ I ’ :  Begin 

Assign( Input Fi le , ’ Input .com’ ) ; 
ExecuteC InputFile ) ; 

End; 

Begin 

Ass ign( Matr ixFi le , ’Matrix . com ’ ) ; 
ExecuteC  Matr ixFi le ) ; 

End; 

i  n 

AssignC  Plotfile , ’plot . com’  ) ; 
Execute (plot file ) ; 

End; 

Begin 

AssignC ControlFile , ’ Control . chn ’ ) ; 
Chain( ControlFile ) ; 

End; 

Begin 

AssignC Obser File , ’ Obser . chn ’ ) ; 
Chain( ObserFile ) ; 

End; 

Begin 


0 


AssignC  LuenbergFi le , ’ Luenberg . chn ’ ) ; 
Chain(LuenbergFile ) ; 

End; 

’ D ’ :  Begin 

AssignC optimalf ile , ’ optimal . chn ’  )  ; 
Chain( optimalf ile); 

End; 

’H’:  Begin 


End 


Assign (Help IFile, ’Helpl  . chn ’  ) ; 
Chain (He lpl File  ) ; 


un  ift.  * 

Begin 

AssignC  PoleFi le , ’ Pole . 
ExecuteC  PoleFi le ) ; 

End; 

Begin 


com  ’  )  ; 


ProgramExi t ; 

if  (ch=’Y’)  or  ( ch  =  ’y’)  then 


Exit  :=  True; 
End ; 
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End:  (case) 
End;  {main  menu) 


(  * 


#######**# 


*»»*»*»«»»#**#♦************»#»******#»**» 
*  Program  Execution  part 

egin  { svs >  , 

ClrScr;  (clear  screen) 

Exit  :=  False  {{initialize  boolean) 

Repeat 

<  >  1  then 


») 


if  blockl 
Begin 
Blockl 
End; 

MainMenu ; 


=  0; 


{  call  main  menu  until  the  user 
want  to  exit) 

Until  Exit=  True; 

Set_Cap_Num( ’  »,»  ’ ) ; Say  Cap  Num; 


Blockl  :=  0; 


*  .  1  J  ,  i'i  urn  ; 

,  (set  caps , inseft , and  num  lock  off) 
{reset  problem) 


wv.v.v.v. 
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Program  input ( input , output ) ; 

{*  This  program  allows  the  user  to  enter . change , save 
and  retrieve  the  problem  for  the  whole  options  on  the 
other  menues.  * ) 

{$1  Typedef.SYS)  (comman  type  &  variable  definitions) 

{$1  Ut-mod01 . INC)  {I/O  utility  routines) 

{SI  Ut-mod02. INC) 

($1  Ut-mod03 . INC) 

{$1  Box. INC)  {draws  menu  box) 


inputdatf ile , savefile .retrieve file, 
changef ile ,help2file 


f  ile ; 


Procedure  InputMenu; 
var  i , Tab  : 

Okchoices  : 

Finished 


Integer : 

Set  Of  Char 
Boolean ; 


Procedure  Menultem( Pick : Char ; Description: St r80 

Color : Integer 


Begin 


1  _L  Ly  JTY  .  w  11  d.1  t  0^1  -LW  U1UU  •  ^  O  1  • 

Color : Integer ) ; 

{displays  menu  items  in  color  ) 


f extCol  or ( color ) : 

Write  (’  ’:tab,  (’);  TextColor (white ) :  Write(pick); 
TextColor ( color  ) ;  Writeln( ’  )  ’  .Description) ; 


End; 

Begin 

ClrScr:  TextColor ( white ) ;  Finished  :=  False; 
GoToXY (20,4);  retr iev : = t rue ; 

Write?’***  ffiPUT  /  CHANGE  MENU  *  *  *  ’); 

for  i  :=  1  to  4  do  writeln( ’  ’); 

Tab  :=  18: 

Menultemf  5 1 ’ , ’ Input  Plant  Matrices  ’.red); 


’  C  ’  ,  ’ 


Menultem( ’ C ’,’ Change  Current  Plant  Matrices’ .yellow) ; 
Wi*  i  1)6 In  * 

Menultem( ’ S ’ , ’ Save  Plant  Matrices  to  Disk 

File ’ .yellow; : 

Menultem( ’ L ’ , ’ Load  Plant  Matrices  From  Disk 

File ’ .yellow) ; 

Wr  i  "t  @  1  n  * 

Menultem( ’ H ’ , ’ Help ’ . 1 ightmagent a ) ; 

Menultem( ’ Q ’ , ’ Quit  to  SVS  Main  Menu  ’ , lightmagenta) ; 
Box;  TextColor ( white ) ; 

Set  Cap  num(’C’  ’  ’);say  cap  num:  gotoxy ( 40 , 22 ) ; 

if  blockl  <  >  1  then  OKchoice^  : =  T ’ 1 5  , ’ L ’  ’ IT  , ’ Q ’ J  _ 

else  OKchoices  :  =  [  ’  I  ’  ,  ’ C ’  , ’ H ’  , ’ S ’ , ’ L ’  , ’ 0 ’ ] ; 

Repeat  {wait  for  user  to  input  a  keyprees) 
option ; 

if  not  (ch  in  OKchoices)  then 
begin  ,  s  , 

beep (900, 350);TextColor(red); 
if  blockl  <>  1  then 

bemsg( ’WARNING:  First  INPUT , RETRIEVE , HELP  or 

QUIT!  ’,1,25); 

end ; 
end ; 

TextColor( white)  ; 
until  Ch  in  OKchoices; 


Set  Cap  num 
if  blockl  < 
e 
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case  ch  of 
’  I  ’  :  begin 


Assign! inputdatf ile , ’ inputdat . chn ’ ) ; 
chain( inputdatf i le ) ; 
end; 
begin 


chain( inputdatf: 
end; 


end : 

’S’:  begin 


Assign! retrievef ile , ’ retr ieve . chn ’  ); 
Chain( retr ievef i le ) ; 


fin 

ssign( savef ile , ’ save . chn ’ ) ; 
Chain(savefile) ; 


end; 

Begin 


End: 

’ H ’ :  Begin 


Assign!  change f i le , ’ change . chn ’  ) ; 
Chain! changef ile  ) ; 


gm 

Assign( help2f ile , ’help2.chn’  ); 
Chain(help2file  ) ; 


End: 

’ Q ’ :  begin 

Assign( svsFi le , ’svs.com’ ); 
Execute! svsFile ) ; 

,  end: 

End;  (case) 
end; 


{  Execution  the  input/change  menu  program.  } 

Begin  {main  program) 
dr ive : = ’ C ’ ; 
repeat 

InputMenu ; 

Until  Finished  =  True; 

End.  {main  program) 
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Program  input  data( input , output ) ; 

(To  allow  thS1  user  to  enter  the  A,B,C  matrix  from  the 
this  program) 

label  13; label  10;label  11;  {label  decleration  for  the 
GOTO  statement } 


<$I 

i!i 


Typedef . sys  > 


Ut-mod0 1  . inc  ) 
Ut-mod02 . inc ) 


{comman  variable  declerat ions ) 
{I/O  routines) 


var  Ans.Cont 
Out 

Stepping , Step , Steps , 
Tempi , Temp2 ,  i  ,  J 
Result 
inputf i le 


Char  ; 
Text ; 


Integer ; 
Real ; 
f  ile ; 


Begin  {input  data) 

1 3 : ClrScr ;~ Wr iteln ; 
block" 

Write! 


rocr;  writein; 

1  :  =  1  :  textcolor(yellow) ; 

(  'Enter  the  degree  of  the 


Readln( size) ; 


plant : 


); 


if 

be 


{size  <=  0)  or  {  size 

gin 

eep( 900 , 350  ) ;  goto  13; 
end; 

for  steps:=1  to  10  do 

for  stepping  :=  1  to  10  do 
Al A[steps , stepping]  :=  0.0; 


>  10)  then 


{ initialize  > 


_  > 


) ; 


Writeln? ’ Enter  the  elements  of  the  A  Matrix  ’); 
writeln ; 

for  steps  : =  1  to  size  do 
Begin 

for  stepping  : =  1  to  size  do 
Begin  . 

Write? ’ A( ’ .steps, ’ , ’ .stepping, ’ ) 

Readln( Al A [steps , stepping] ) ; 

EndjWriteln; 

End; 

Repeat 

ClrScr;  Writeln; 

Writeln(’The  A  Matrix  is  :  ’);  writeln; 

for  steps  :=1  to  size  do 
Begin 

for  stepping  : =  1  to  size  do 
Begin 

Write? ’  ’ , 

End;  Writeln; 


Al A  [steps , stepping] 

End; ~wr itelnl  ’{prompt  to  any  changes) 
Write(’Do  you  want  to  change  any  eleme 
write?’  the  Matrix  ?  (  Y  /  N  7  ’ ); 


11); 


ement  of ’  )  ; 


Read? Kbd , Ans ) ;  writeln; 


{allows  user  to  change 
entered  data) 

if  (  Ans  = ’ Y ’ )  or  (  Ans  =  ’y’)  then 
Begin 


write? ’Input  the  row  to  change 


rrite(  ’  Input  the  column 
readln( 1 ); writeln ;  v 
Tite( ’ A( ’ , i , ’ , ’ , j , ’ )= 
l1  A  [  i  ,  j  ]  :  =r  esul  t ; 


)  ;  readln( i  )  ; 


to  change  :  ’*)*; 

)  jreadln(result) ; 


in  [  ’  N 


]; 


0 : ClrScr •wri'fcGln* 

user  inputs  B  matrix  elements  from  the  keyboard) 
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write( ’How  many  inputs  do  you  have  ?  ’  ); 

readlnf ni ) ; wr iteln ; 

if  (  m  <  1  )  or  (ni  >  size)  then 

begin 

beep( 900 , 350 ) ;goto  10; 
end; 

for  steps  : =  1  to  10  do 
for  stepping:=1  to  10  do 
BTsteps , stepping]  :=  0.0; 

WritelnC ’ Enter  the  elements  of  the  B  Matrix  ’)  ; 

Wr iteln ; 

for  steps  : =  1  to  size  do 
Begin 

for  stepping: =1  to  ni  do 
to  e&in 

wr ite( ’ B( ’ .steps , stepping )  =  ’); 

Readln(  B  [  steps , stepping  ]); 
endjwriteln; 

End;  Writeln; 

Repeat 

ClrScr;  Writeln; 

Writeln(’The  B  Matrix  is:  writeln; 

for  steps  :=1  to  size  do 

Begin 

for  stepping: =1  to  ni  do 

begin  ,  . 

write?’  ’, B[steps , stepping] : 1 1  ) ; 
end;  writeln; 

En  d  *  riteln  * 

Write( ’Do  you  want  to  change  any  element  of’); 
write?’  the  B  Matrix  ?  (  Y  /  N  )  ’); 

R@std.(  Kto d  Ans  )  * 

writeln; ’ {allows  user  to  change  B  matrix  element) 
if  (  Ans  = ’ Y ’ )  or  (  Ans  =’y’)  then 


of  the  B  Matrix 


r ite( ’ B(  ’  .steps stepping ,’  )  =  ’) 

eadln(  B  [  steps , stepping  ]); 


Ans  = ’ Y 


Begin 

write? ’Input  the  row  to  change 
write( ’ Input  the  column  to  cha 


then 


wnte(  ’  input  the  co 
readln(i);  writeln; 
writei  B( ?  ,i.  ’  ,  ’  ,  j  , 
BL i , j  j : =resul t ; 


Input  the  row  to  change  :  );  rea 

Input  the  column  to  change  :  ’ ) ; 

1 ):  writeln ; 

6(5,i.  ’,’,],’)=  ’) ; readln( result ) 


eadln( i ) ; 


End; 

Until  Ans  in  C’N’.’n’]; 

11 :Clr Sc r;  Writeln:  . 

(user  inputs  output  data  from  keyboard) 
write(’How  many  outputs  do  you  have  ? 
readln(no):  .  ,  . 

if  (  no  <  1  )  or  (  no  >  size  )  then 

begin  , 

beep( 900 , 350 ) ;goto  11; 
end; 

for  steps :=  1  to  1 0  do 


>r  steps :  =  i  to  i  w  do 
for  ..stepping:  =  1  to_  1  0  do 
C I  steps , stepping] : =0 . 0 ; 


C T steps , stepping] : =0 . 0 ; 
wr iteln * 

Writeln? ’ Enter  the  elements  of  the  C  Matrix 
Writeln ; 

for  stepping  :=  1  to  no  do 
Begin 

for  steps  :=1  to  size  do 
begin 

Write(  ’ C(’  , stepping,  steps  ,’  )  =  ’); 

Readln(  C[stepping, steps] ) ; 
end;  writeln; 

End;  writeln; 

Repeat 

ClrScr;  Writeln; 

Writeln(’The  C  matrix  is  :  ’);  writeln; 
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for  stepping  :=  1  to  no  do 
Begin 

for  steps:=1  to  size  do 
begin 

write!’  ’ ,C[stepping, steps] : 1 1 ) ; 
end;writeln; 

End:  Writeln; 

Write! ’Do  you  want  to  change  anv  element  of’); 
write( ’  the  C  Matrix  ?  !  Y  /  N  )  ’); 

Read/ tV,~ J  ’ 

if  r 

Ti _ J 


Read( Kbd , A 
if  (  Ans  = 
Begin 

wr ite(  ’  I 
write(  ’  I 
readlni i 
write!  ’  C 


the  C 

, Ans ):  writeln; 

*’Y’5  or  (  Ans  =’y’)  then 

Input  the  row  to  chnage  : 
Input  the  column  to  change 


readln(l):  writeln; 
End ; 

Until  Ans  in  [’N’.’n’]; 


■eadln( i ) ; 


) ; readln( result ) ; 


Assign! inputf i le , ’input.com’ ) ; 

{ re-execute  the  input/change  menu  program) 
Execute! inputf ile) ; 

End. { input_data) 
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Program  change  data( input , output ) ; 

This  program  allows  the  user  to  change  A,B,  C 


matrices  and  their ~matrix~"order  . 


* 

# 

* 

*  $ 


1 1 ; label  1 2 ; label  1 4 ; 

($1  Typedef.sys)  (comman  type  &  variable  decleration) 


;i 

;i 


Ut -mod0 1 . inc 
Ut-mod02 . inc 


(I/O  utilities  > 


var  Ans , temp , input type 

Stepping , Step .Steps , i ,  1 
Result 
inputf ile 
result  size 


Char  ; 
Integer ; 
Real  ; 
file; 
integer ; 


Begin 

clrscr ; writeln ;  gotoxy ( 1  , 22  )  ; 
mvvideo(  Press  <ESC>  to  change  it!, 
gotoxy (1 ,23); 

mvvideo( ’ Then  input  your  choice  with  < ENTER >  key’); 


’  ); 


—  — ■  -  —  ■>“  y  «  \  ♦  **  «->  **  -4.  n  u 

text col off 1 ightblue ) ; 
wr  iteln( ’  *  *  *  Cha 


«— x  ,  _  Change  Current  Plant  Matrices 

Procedure  ***’); 


TextColor Cyellow) ; 
wr i teln( ’ ============ 


Msg( ’Which  matrix  do  you  want  to  change  ? 
textcolor ( 1 ightmagenta ) ; 


’,1,6); 


msgf 
msg 
msg(  ’ 
repeat 


PLANT 

INPUT 

OUTPUT 


’  >39,  ( 

’  ,  1  .-t 
’,1,8 


); 


input ( ’A’  ’A’ ,50, 6. 2. true, FI , 
temp : =copy( answer , 1 . 1 ); 

if  not  (temp  in  [ 5 A ’ , ’ B ’ , ’ C ’ ] )  then  beep ( 900 , 350  )  ; 


until  temp  in  [’A’,’B 
inputtype:=  temp; 


true  ,  FI  ,  FI  0  ) ; 

y 

9 

’  ,  ’C’]  ; 


’  )  ; writeln ; 
do 


case  inputtype  of 
’ A ’ : begin 

1 4:ClrScr ; 

writeln(’The  A  matrix  is 
for  steps:=1  to  size  do 
begin 

for  stepping:=1  to  size 
begin 

wr  ite(  ’  ’,A1A[steps, stepping] : 1 1  ) ; 

end;writeln; 

Wr iie(  * The^order  of  the  system  is:’, 

write( ’ SChange  ?’( 
repeat 

read( kbd , ch ) 

until  ch  in  [ * Y ’  ’ N ’ , ’ v ’ n ’ ] ; 

if  (ch=’Y’)  or  (ch=’y’)  ihen 
begin 

wr  i  "t  0 1  n  * 

write(’i'he  order  of  the  system  is 
readln( result  size); 
if  (result  si!Ze<1) 
then  begin  ~ 

beep (900 , 350  )  ;  goto  14; 


Y/N) ’ ); 

Tti: 


); 


or  ( resul t_si ze > 1 0 ) 
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size  ; 


end ; 

size : =result 
end ; 
repeat 

clrscr ;writeln; 

Writeln(’The  A  Matrix 
for  steps  :=1  to  size 
Begin 

for  stepping  :=  1  to  size 
Begin 

Write( ’  * ,A1A[steps, stepping] : 1 1 ) ; 

End;  Writeln; 

End; Wr iteln ; 


is 

do 


) ; wr iteln ; 
do 


Write(  ’Do^y^u^nt^to  change  any  element? 


Read! Kb Ans )  ;wp iteln 


ai-vxAo  )  j  wr  i  1 6 xii »  _ 

ns  in  T  ’N’,?n’])  then 
if  (  Ans  =  ’Y’)  or  (  Ans  =  ’y’)  then 
Begin 

wnte(  ’Input  row  to  change  :  ’); 

readln(i); 

write!’ Input  column  to  change 
readln(.i);  writeln; 
writef ’A(  ,i.’.’,j, *)*’)> 

readlnt result ) ; 

A 1  A [ i »  j ] : =result ; 

End; 

Until  Ans  in  [’N’.’n’]; 
end: 

’ B ’ : begin 

1 1  : C 1 r Sc  r  • 

wr  i  teln(  ’ 'i'he  B  matrix  is  :’);writeln; 

for  steps: =1  to  size  do 

begin 

for  stepping: =1  to  ni  do 
begin  r 

write( ’  ’ , B[steps , stepping] : 1 1 ) ; 

end;writeln; 
end; writeln; 

Write! ’The  number,  of  input  is  :  ’,ni 
Change  ?,  fY/N)’); 


’  ) ; 


repeat  read!  ^£bd  ?  chj) 


•Vi* 


n  ’  ]  ; 
en 


until  ch  in’ [’Y1 , ’ N ’ 
if  { ch= ’  Y  ’  ) 
begin 

writeln;  (allow  the  user  to  change  number 
,  of  input) 

write! ’The  number  of  input  is:’); 
re^dln!  result_sipe ) ; 

or  (result  size>10) 


if  (result  siz^<1) 
then  begin 

beep! 900 , 350 ) ;  goto  11 
end; 

ni:=result  size; 
end ; 
repeat 

clrscr ; writeln; 

Writeln! 'The  B  Matrix  is 
for  steps  :=1  to  size  do 
Begin 

for  stepping  :=  1  to  ni 
Begin 

Write!’  ’, B [steps , stepping]  : 1 1  )  ; 

End;  Writeln; 

End ; Wr i te In ; 

{prompt  the  user  for  changes  on  B  matrix) 


) ; wr i teln ; 


do 
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o  you  want  to  change  any  element 


Write!  ^ou  ^w^n^to  change  a 

Read(Kbd.Ans)  ;writein: 
if  not  (Ans  in  L  ’N’,  n’])  the 
if  (  Ans  =  ’  Y  ’  )  or  (  Ans  = ’ y ’ ) 
Begin 

write( ’ Input  row  to  change  : 
r eadln! i ) ; 

write(’ Incut  column  to  change 
readln! 1 ) : 

writeln: write! 'B( ’ ,i, ’ , ’ ,j , ’ ) 
readln! result ) ; 

B[i  ,  j ] : ^result ; 


s  m  [  ’N’,’n’])  then 
=  ’  Y  ’  )  or  (  Ans  =’y’)  then 


’  ,J  ,’)=’) ; 


B[i  ,  i ] : ^result ; 

End; 

Until  Ans  in  [’N’,'n’]; 
end: 

’  C ’  : begin 

T2 : Cl rScr • 

wr iteln( ’ ^he  C  matrix  is  :’);writeln; 

for  steps:=1  to  no  do 

begin 

for  stepping:=1  to  size  do 
begin 

write!’  ’, C[steps , stepping] : 1 1 ) ; 
endjwriteln; 
endjwriteln; 

(allow  the  user  to  change  number  of  outputs) 
Write! ’The  number  of  output  is  :  ’ ,no. ’ ); 

write!’,  Change  ?  [Y/N)’); 
repeat  read(kbdfch) 

until  ch  in  [ ’ Y ’ , ’ N ’ . ’ y ’ , ’ n ’ ] ; 
if  (ch=’Y’)  or  (ch=’y’)  then 
begin 

wr  i teln * 

write!  "the  Number  of  Output  is  :’); 
readln! result  size); 

if  (result  siTJe<1)  or  (result  size>10) 


of  Output  is  : ’ ) ; 
I 


then  begin-  ~ 

beep! 900 , 350 ) ;  goto  12; 
end; 

no:=result  size; 
end;  ~ 

repeat 

clr scr ; wr i teln ;( show  C  matrix  elements) 
Writeln(’The  C  Matrix  is  :  ’ ) ;writeln; 

for  steps  :=1  to  no  do 
Begin 

for  stepping  :=  1  to  size  do 
Begin  r 

Write(’  ’, C [steps , stepping] : 1 1 ) ; 

End;  Writeln; 

EndjWriteln; 

(prompt  the  user  for  changes  on  C  matrix  ) 


show  C  matrix  elements 
latrix  is  :  ’ ) ;writeln; 


Write!  |ou  ^wan^to  change  a 

Re ad ( Kb d, Ans) ;writein; 
if  not  (Ans  in  [  ’N’,!n’])  then 
if  (  Ans  = ’ Y ’ )  or  (  Ans  =’y’) 
Begin 

write! ’Input  row  to  change  : 
r eadln! i ) ; 

write( ’Input  column  to  change 


change  any  element 


=’Y’)  or  (  Ans  =’y’)  then 
;rn^ut  row  to  change  :  ’  )  ; 

‘nput  column  to  change  :  ’ ) ; 


write! ’Input  column  to  change  :  ’ 

readln! j ) : 

writeln: wntei  ’C(  ’  ,i,  ’  ,  ’  ,j  ,  ’  )=’  ); 

readln! result); 

C [i , 1 ] : =resul t ; 
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?na; 


Until  Ans  in  [’N’.’n’l; 
end ; 


Assign( inputf i le input . com ’) ;  (re-execute  input 

Execute( inputf ile ) ;  program 

End. (change) 
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FILE:  SAVE. PAS 

Program  save_data; 

($1  Typedef . SYS } 

<  $1  Ut-mod01  . INC  } 
($1  Ut-mod02 . inc ) 


var 

filename 
blockf ile 
i  ,  j 

inputf i le 
begin  {save 


clrscr 


:  str20; 

: text ; 

:  integer; 
‘.file; 
dat  a } 


( 

Msg 


.et 

>  *  * 


if 


necessary } 
Press  <esc> 


to  change 


HighVideo ; 

user  to  change  drive 
Your  Data  Drive  is 
it ! *  *  ’  ,10,11  )  ; 
repeat 

input ( ’ A ’ , copy ( drive, 1 ,1 ) 
ch:=  copy ( answer , 1 , 1 ) ; 
if  notion  in  £’A?,!B*  ’ 

beep(350 ,150): 
until  ch  in  L’A’.’B’,’! 

Drive  :=  concat ( ch ,  ’  :  ’ 
clrscr;  (prompt  for  filename  to  store  data} 

msg( ’ Input  name  of  file  to  save  data  in  File’, 1,10) 
writeln;  writeln; 


C  ’ 
’D 


32 

•D 


1 1 ,2, true, FI ,F1 0) 
, ’ E ’ ] )  then 


r*  1  X  J.U  •  rr  x 

writeln!  ’ *  *  *  Y 
’  , Dr ive , ’  *  *  *  ’ 
input (  ’  A  ’  ,  ’  ’  ,  4 
filename :=  concat 


ur  DATA  disk  must  be  in  drive 


10, 8, true, FI ,F10); 
t ( Dr ive , copy ( answer ,1 , 8 ) , 


svs  ’  ) 


Assign( 
rewrite 
Writeln 
Writeln 
Writeln 
for  i  :  = 
for  j 


ilockf i le , filename ) ; 
Blockf i le) ; 
Blockfile.size) ; 
Blockf i le , ni ) ; 
Blockf i le , no ) ; 

1  to  size  do 
=1  to  size  do 


(Open  file  } 


wr ite( blockf ile , A1 A[i , j ] ) : 
for  i:=1  to  size  do 
f or  1 : =  1  to  ni  do 

wnteln(  blockf  1  le  ,  B[i  ,  j  ]  ) ; 
for  i : = 1  to  no  do 

for  1 : = 1  to  size  do _ 

wr i te( blockf i le , C [ i , j ]  ) ; 


close( Blockf ile ) ; 
Assign( inputf i le , 


{close  the  file) 


Execute! inputf i le ) 
end. {save  data) 


’input.com’  );{ re-execute 
input /chamge  menu  program) 
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Program  Listing 
Program  retrieve  data; 

($1  Typedef.SYS)  (variable  decleratios) 

($1  Ut-mod0 1 . INC }  (I/O  routines} 

($1  Ut-mod02 . INC) 

($1  Ut-mod03 . INC } 

($1  Directry . INC )  (shows  available  data  files} 


var 

r eadf i le 
filename 
reader ror 
1 inecounter , i  , 


:  text;  (The  text  file  user  will  use} 
:  s  t  r  2  0  ; 

:  boolean; 

j  :  integer:  {  A  counter  for  the 
lines  we  read} 
inputf i le , PlotFi le :  file; 


be 


in  {  procedure  retrieve  data} 
ulrScr ;HighVideo ;  ~ 

{  Allow  change  of  disk  drive  if  desired} 
blockl : = 1 ; 

Msg(’**  Your  data  drive  is 

it!  **’,10,11); 

Repeat 

Input ( ’ A ’ , copy ( dr i ve  .  1 ,1 ) 

Ch;.  cpg^ansyer,,,,);,^ 


Press  <ESC>  to  change 


If  noti 


beep! 900 , 350 ) : 

Until  ch  in  [  ’  A  5  ,  ’  B  ’  ’  C  ’  ,  ’  D 

Drive:=  concat ( ch , ’ : ’ ) ; 


32,11  , 2 , true , FI  ,F1 0  )  ; 
’D’ , ’E’ ] )  then 
,  ’E’]  ; 


{  Call  directory  to  display  eligible  files} 
Directory! drive, extension , filename , reader ror ) ; 

If  not ( reader ror )  then 


Begin 


issign! readf ile , filename ) ; 

(  Open  the  file  and  read  contents} 

Reset ( readf i le ) ; 

Linecounter : =0 ;  „  (count  the  lines  } 

While  not  EOF! readf i le )  do 

(The  built-in  function  EOF  returns  true} 
BeginUf  the  end  of  a  file  has  been  reached) 

Linecounter := 1 inecounter+1 ;( Count  the  next  line} 
Readln( readf i le .size): 

.  (  Read  it  into  variable  line  } 

Readli  - 

Readli 


For 


.n! readf ile , ni ) ; 
.n( readf ile , no ) ; 
i : = 1  to  size  do 


i or  3 :=  1  to  size  do 

Read( r eadf i le , A1 A [ i , 1 ] ) 
For  i : =1  to  size  do 
For  1 : = 1  ton!  do 

Readln( r eadf i le , B [ i , i ] ) 
For  i :=  1  to  no  do 
For  1 : = 1  to  size  io 

Read( readf i le , C [ i , 1 ] ) ; 
End;  Close ( r eadf i 1 e ) ; 

End 

Else 

Begin 

Belay( 1500); 

(  Wait  for  directory  error 
Window! 1 ,1 ,80 , 25 ) ; 

Clrscr ; 

End ; 

if  not  (retriev)  then 
begin 

Assign! Dlotfi le , ’Plot.COM’ ); 
Execute! PlotFile); 


message  and  continue) 
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end 

else 

begin 

Assign( inputf i le , ’ input . com ’ ) ; { r 
„  ,  v  input/change 

Execute( inputf ile  )  ; 

end: 

End.  {retrieve  data) 


-execute 
menu  program) 
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Program  Plot: 

{  Program  plot  contains  graphic  programs.  They  are 
written  by  WOOD  Roy,  Jr.  and.  modified,  for  this 
program.  > 

{$1  Typedef . SYS ){ type  and  variable  decleration  routine) 

($1  Ut-mod0 1  . INC  )  (I/O  routines  ) 

($1  Ut-mod02 . INC ) 

($1  Ut-mod03 . INC) 

($1  Box. INC)  (drawing  menu  box  > 


var 


4a1, 


•  In,*t©££6r  * 

p4f i le , Retr ievef i le , Nyquistf i le ,  ' 

timeplotfile .bode file, rlocifile.rootsfile  : 


File; 


Procedure  Gr aphicsMenu ; 
var 

i  ,  Tab 

Okchoice 

Finished 


Integer : 

Set  Of  Char 
Boolean ; 


Procedure  Menultem( Pick : Char ; Descr ip t ion : St r80 ; 

Color : Integer ) ; 

(gives  easy  selection  of  input  menu  colors) 
?extCol  or ( color  )  : 

Write  (’  ;:tab,’(’);  TextColor (white ) :  Write(pick); 

TextColor ( color  ) ;  Writeln(  ’  ) ’ .Description) ; 

End; 


Begin 


@lrScr ; TextColor (white ); 
Finished  :=  False : GoToXY( 20 , 4 ) ; 
Wr i teln( ’  ***  GRAPHICS  MENU 


*  #  *  »  )  . 

(display  graphics  menu) 


Wr iteln : 

Tab  :=  ], 

Menult< 

Fi: 

Writeln * 

Menultem( ’ C Character istic  Equation  Roots’ .yellow) ; 


n : 

;em  ’ 
le  ’  , 


L’.’Load  Plant  Matrices  From  Disk 
red )  ; 


Menultemf ’H’ , ’Help 


’B’.’Bode  Plot  ’.yellow); 
’T’.’Time  Response  Plot yellow) ; 
’N’.’Nyquist  plot ’ .yellow^ • 


Menultem 
Menultem 

Menultemi ' N ' , ' Nyquist  plot’.y _  „ , 

Menultem( ’ R ’ , ’ Root  Locus  Plot ’ .yellow) ; 


Menultem( ’ Q ’ , ’ Q 
TextColor (green 
Box;  Writ 


gre 


v. 


it 


, 1 ightmagenta ) ; 

to  SVS  Main  Menu  1 ightmagenta ) ; 


TextColor (white ) ;  retriev: =f alse ; 

GoToXY  (40,22); 

repeat  (  read  user  choice  from  keyboard) 

option; 

until  ch  in  [ ’ R ’ , ’ L ’ , ’ B ’ , ’ T ’ , ’ N ’ , ’ H ’ , ’ Q ’ , ’ C ’ ] ; 
case  ch  of 
’R’  :begin 

assign(rlocifile, ’rloci.chn’  ); 
chain ( rlocifile)  ; 
end : 

’ L ’ :  Begin 

Assign(retrievefile, ’retrieve. chn ’  )  ; 

Chain ( retrieve file); 


end : 
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begin 

Assign( timeplotf i le , ’ t imeplot . chn ’ ) ; 

Chain ( timeplotf i le ) ; 
end; 
begin 

Assign( Bodef i le , ’ Bode . chn ’ ) ; 

Chain(bodef ile ) ; 
end; 
begin 

Assignf nyquistf i le , ’ Nyquist . chn ’ ); 

Chain ( Nyquistf i le ) ; 
end; 

Begin 


End; 

’H’  :  Begin 


ssign( r ootsf i le ,  ’roots. chn’  ); 
Chain ( rootsfile) ; 


imi 


gm 

Assign(Help4Fi le , ’ Help4 . CHN ’ ) ; 
Chain( Help4Fi le  )  ; 


End; 

begin 


End; 

End; 


Assign( svsFile , ’ svs . com ’ ) ; 
Execute ( svsFile) ; 
end; 


Begin  {plot} 
ar ive : = ’ C ' ; 


^initialize  drive  selection  for  load  procedure) 

J»0pg  3.*t 

GraphicsMenu;  (repeadely  call  graphics  menu  until 

user  selects  to  quit) 

Until  Finished  =  True; 

End.  (plot) 


jCLAfJl  “-ft.  -A  V 
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Program  time  response: 

label  13;  {label  decleration  for 


Typedef . sys  ) 
Graphix . sys  > 
Kernel . sys ) 
Windows . sys } 
Axis . hgh ) 
Polygon. hgh> 


GOTO 

(graphics  routines) 


Page  1 
statement ) 


Ut-mod01 . inc 
UT-mod02 . inc 
Ut-mod03 . inc 


(I/O  routines ) 


($1  GrapMenu. inc) 


type 
ary4 
ary  6 


=  array 
=  ar  r  ay 


(graph  option  menu  procedure) 


of  real; 
of  integer ; 


var 

Psi , Phi , A , Atemp 
temp,  inputtype 
Offset, SI ope, Tmax , 

RowSum , MaxRowSum , T , 

T1 , OldMaxRowSum , 

Plot time , Uinput , PhiX , 
hold , Ymax , Ymin , TPlot , 
Amplitude,  Freq.y 
Factorial , Plot index , 

Nincr . code , i , 

i'j  , j , 1 ,m,n ,kk , cnpoles , sizezero 
umpGraph , GoodN umbers , 
ClosedLoop , quit 
Cl , Xo Id, Xnext , Gamma 
GraphAr ray , Input array 
li  i  s  o 

numcoef f , dencoef f , cdencoef f 

Irlr  1 

plotfile 


aryl s ; 
char  ; 


:  real ; 


integer ; 


boolean ; 
ary 3s ; 
plotar ray ; 
text ; 
arv4; 
integer ; 
file; 


51  Polynom.inc) 
>T  Boxuser.inc) 


(characteristic  equation  procedure) 


Procedure  PrintGraphData: 

(this  procedure  dumps  time-response  data  to  printer) 
uegin 

LeaveGraphic ; Clrscr ; 
repeat 

Textcolor ( white );  gotoxy( 20 , 1 0 ) : 
writelnf ’  *»*  PROGRAM  OUTPUT  OPTIONS 

gotoxy ( 20 , 13); 
writeln( ’ <P>  Printer  output 
Textcolor (yellow) ;  gotoxy ( 20 ,14); 

writeln(  Check  Your  Printer! 

Textcolor ( white ) ;  gotoxy ( 20 , 1 5 ) ; 

wr iteln(  <F>  tist  to  File  name 
gotoxy (20 ,16); 

writelnf’  on  the  current  drive 

gotoxyf 20 ,17): 
writelnf ’ <Q>  Quit 


’  ) ; 
); 
); 

’  ) ; 
’  ) ; 


1  UCilH  '■w/  VUXU  ’); 

gotoxy ( 42,15); textcolor (yel low ); write ( ’ "TIME . RES" ’ ) ; 


"fjfohJ'F' J'or  (Oh.-f-)  or  (oh-’P-)  or  (ch.'p') 
then 
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begin 


F  ’  ) 


Program  Listing 
or  ( ch  =  ’ f ’ )  then 


if  (ch  = 
begin 

gotoxy ( 24,15); text col or ( red ) ; 

write(  ’ PRINTING . 

assign! list , ’ Time . RES ’ ) ; 
rewrite! list ) ; 
end 
else 

begin  7  , 

gotoxy( 24,1 3) ;text color! red); 

write! ’ PRINTING. . . 

assign! list , ’ LST : ’ ) ; 
rewrite! list ) ; 
end; 


’  ); 


) ; 


cuu. 

writeln(list 


writeln( list ) . 
writeln( list , 5 

( input ) 


Result  * ) ; 


TIME  RESPONSE  PLOT 


’  \ ; 


TIME  (Sec) 
output  ) 


R 


1  ]  :  1  0  :  5 


writeln! list ,  ’ - 

writeln! list ) ; 
for  i  : =  1  to  200  do 
writeln! list ,  ’  ’  , ( 

GraphArray 
InputArray [i . 2J ; 1 t 

end; 

until  ch  in  [’Q’.’q’]; 

EnterGraphic ; 
swapscreen : 
close! list ) ; 
end; 

Procedure  Matrix  Mul t ( Matr ixl ,Matr ix2 : ary 1 s ; 

var  AnswerMatr  ix :  ^.ryl  s  ; 


); 


var  i  ,  j 
begin 


integer ; 


Order : integer 


or  i:=1  to  order  do 
for  to  order  do 

AnswerMatrix[i , j J  :=  0; 

{initialize  the  answer  matrix) 


for  i:=  1  to  order  do 
for  3 : =  1  to  order  do 
for  L  : =  1  to  order  do 


end; 


>r  j_i  :=  i  to  order  do 

AnswerMatr  ix  [  i  ,  ,1  J  :=  AnswerMatr  ix  [i  ,  1 
Matr ixl [i , LJ *Matrix2 [L , J J ; 


Procedure  Scalar  Mult(Matrix1  :  aryls;  scalar  :  real; 

var  AnswerMaxrix: ary 1 s ; 

Order : integer  ) ; 
var  i , J  :  integer ; 

begin 

for  i:=  1  to  order  do 
for  j:=1  to  order  do 

AnswerMatr ix [ i , j J : =  AnswerMatr ix [ i , J J  *  scalar; 

end ; 

Procedure  Matrix  Vector_Mult(Matr ixl  taryls; 

Vector  :  ary3s; 

var  Answer Vector : ary3s ; 

order : integer  )  ; 
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var  i , 3  :  integer; 

begin 

for  i : =  1  to  order  do 
begin 

hold:=  0; 

for  1 : =  1  to  order  do 

hold:=  hold  +  Matr ixl [ i , j ] *Vector [ j ] ; 
AnswerVector [i] : =  hold; 

end; 

end; 

Begin 

Initgraphic ; leavegraphic ; 

Boxuser * 

Characteristic  Equat ion( A1 A , size , Dene oef f ) ; 

{calculating  denominator  coefficient) 

for  i :  =  1  to  size  do  PSI [i , size] : =B [i  ,  1 ]  ; 

for  J]:=2  to  size  do 

begin 

for  i:=1  to  size  do 
begin 

1  :=size-d J+1  ; 

rCiC  1  •  r  1  1  • 

PSI [i , j 1 : =Dencoef f [kkl ]  *  B [ i , 1 ] ; 
for  lt=i  to  size^do 

PSI t i , j  J : =  PSI [ i , j ]  +A1 A [ I , 1 ]  * 

end ; 
end ; 

for  i:=1  to  size  do 

^  J  (calculating  numerator  coefficients  ) 

begin  _  _ 

Numcoeff [i] : =  0.0; 
for  J  : » 1  to  size  do 

Numcoeff [ij : =  Numcoeff[i]  +  PSI[j,i]  *  C[l,i]; 

G  x  1  CL  | 

for  i:=i  to  size  do  {calculating  numerator  order  > 
begin  ° 

m j =size+1 -i * 

if  Numcoeff tm]  <>  0.0  then  goto  13; 
end; 

1 3 : sizezero : =m-1 ; 

Clr scr  ; 

Text Co lor ( 1 ightblue  )  ; 

writeln( ’  ***  Time  Response  Plotting 

Parameters  ***’); 

TextColor ( yel low ) ;wr iteln( ’==== 

Msg( ’What  is  your  input  to  the  sy 


PSI[1 ,kk1 ] ; 


your  input  to  the  system? 

Msg(  ’ 

Msg(  ’ 

Msg(  ’ 

J»QPg 

Input ( ’A’ , ’S’ ,50, 6,2. true, FI ,F1 0 ) ; 
temp  :=  copy ( answer . 1  ,  1  T  ; 
if  not  (temp  in  [ ’ S ’ , 1 R ’ , ’ W ’ , ’ I ’ ] ) 
...  rBeep(356.15 &);  n 

until  temp  in  [ ’ S ’  , ’ R ’ , ? W ’  ,  ’  I  ’  ]  ; 
InputType  :=  temp; 

Msg( ’What  is  your  input  amplitude?  ’ 
Input (  ’ N ’  ,  ’1  ’  ,35,11  , 5 , true ,F1  ,F1 0  )  ; 
val( answer .Amplitude .code); 


=  =  =  =  =  =  =  1  ) 
STEP  (S) 

’  ,1  ,6)  : 
RAMP  (R) 


) 


’  1  7  )  • 

SINE  wAv£  (W 


IMP^L^I  (  I ) 

’,1,9); 


then 


i,ii): 


u 


k*Jkt 
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case  InputType  of 
’ R ’ :  begin 

Msg( ’What  is  your  DC  value?  ’,1,13); 

Input ( ’N’ , ’0’ .28, 13,5, true, FI ,Fi 0 )  ; 
val ( answer  ?Offset,code); 
msg(’What  is  your  slope?  ’,  1,15); 

Input ( ’N’ , ’ 1 ’,23,15, 5. true , FI ,F1 0 ) ; 
val ( answer , slope , code ) ; 
end  j 

’W’ :  begin 

Msg( ’What  is  your  frequency? 

( rad/ sec j ’ ,1,13); 

Input ( ’N’ , ’ ’ ,35, 13, 5. true, FI ,F10); 
val ( answer , Freq , code ) ; 
end ; 

end; 

Msg(’Open  (0)  or  Closed  (C)  Loop  Plot  ?  ’,1,17); 
reve  3l1) 

Input ( ’A’ , ’C’ ,40, 17, 2, true, FI ,F10); 
temp  ;=  copy ( answer , 1 , 1 ) i 

if  not  (temp  in  [  ’  0  5  .  5  C  ’  J  )  then  beep ( 350 , 1 50  )  ; 
until  temp  in  [’0’,’C’]; 
if  temp  =  ’C’  then  ClosedLoop:=  true 

else  ClosedLoop:=  false; 

Msg( ’ Input  your  simulation  time  for  the  system  (99 

max) ' ,1 ,20) ; 

I*  ©"D  6  3t*t 

Input ( ’N’ , ’ ’ ,55, 20, 5. true, FI ,F10); 
val(answer , Tmax, code ) ; 
if  Tmax  >  99  then  beep ( 350 , 1 50 ) ; 
until  (Tmax  <=  99)  and  (  Tmax  >0)  ; 


until  (Tmax  <=  99) 
Boxuser ; 

if  ClosedLoop  then 
begin 


for  i:=1  to  maxorder  do  CDenCoeff[i]  :=  0. 

< initialize) 
for  i:=1  to„sizeZero  +  1  do  , 

CDenCoeff[i]  :=  Numcoeff[i]  ; 

(C.L.  denominator  equals  the  sum  of  open  loop 
denominator  and  O.L.  numerator  ) 


for  i ; = 1  to  SIZE  +  1  do  _  _  _  _ 

CDenCoeff[i]  : =  CDenCoeff[i]  +  Dencoeff[i]; 
if  size  >  sizezero  then  CNpoles:=  size 

else  CNPoles:=  SizeZero; 

(Nploes  shold  always  be  greater, but  to  be  safe) 

end 

else 

begin 

CNpoles : =Size ; 

for  i  :  =  1  to  size  do  , 

CDenCoeff [i J : =Dencoeff [i] ; 

end ; 

(  Calculation  of  new  A  matrix) 

for  i:=  1  to  CNPoles-1  do 
begin 


1  .  0 
0.0; 


for  j : = 1  to 
begin 

CNPoles 

do 

if  j  =  i+1 

then  A[ 

!  i  ,  .1  ] 

else  A[ 

.  i  .  j  J 

end ; 

end ; 

76 
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jvi'i.ih: 
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{Calculation  of  new  C  matrix  } 

for  j : =  1  to  CNPoles  do 
begin 

A [CNPoles , j ]  :=  -CDenCoef f [ 1 ] ; 
end; 

for  i:=  1  to  CNPoles  do 
begin 

if  i  >  SizeZero  +  1  then  Cl[i]:= 

_  else  Cl[iJ:=  f 

if  SizeZero  =  CNPoles  then 
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=  0.0 

NumCoeff [i] ; 


li  bizezero  =  CNPoles  then 

C1[il  :=  C1[iJ  +  NumCoeff [SizeZero+1 ] 
,  ALCNPoles , l] ; 

end; 

{  Selection  of  sampling  time  interval  } 

Nincr  :=  1000; 

T  :=  ( Tmax/Nincr ) ; 

Atemp  :=A; 

Psi  :=  A;  {initialize  psi  to  the  value  of  the 
infinite  series  after  the  first) 


Scalar_Mult ( Psi ,T/2 , Psi , CNPol 
for  i:=  1  to  CNPoles  do  {two 
„  Psi [i , i] :=Psi[i,i]  +  1.0; 


6  S  )  J 

terms  I  +  A* T  /  2 !  ) 


=  T;  Oldmaxrowsum: =  0.0; 


Factorial  :=  2;  T1  :=  T;  Oldmaxrowsum: =  0.0; 
repeat 
begin 

Factorial  :=  Factorial  *  (i+1);  T1  :=  T1  *  T; 
Matrix  Mult (A, ATemp , Phi .CNPoles) ; 

{phi  is  used  at  temp) 

ATemp:=  Phi:  {holding  matrix  to  large  array) 
Scalar_Mult( Phi , (T1 /Factorial ) , Phi , CNPoles ); 

for  j:  =  1  to  CNpoles  do 
begin 

for  m:=  1  to  CNpoles  do 
begin,. 

Fsi [ j ,  m] : =Psi [J ,m]  +  Phi[J,m]; 
end ; 
end; 

t Maxrowsum : =  0.0; 

{ computes  maxrowsum  as  measure  of  change  in  last) 
for  j:=  1  to  CNpoles  do{series  term  to  be  added.) 

begin 

rowsum : =  0.0* 

for  m:=1  to  CNPoles  do 

rowsum:=  rowsum  +  Psi [ j ,m] ;writeln ; 
if  rowsum  >  maxrowsum  then  maxrowsum  :=  rowsum; 

end : 

if  ( abs ( maxrowsum-ol dmaxrowsum ) /maxrowsum ) <  0.001 

,  ,  then  finished  :=  false 

{quit  when  . 1 ^change )  else  finished  :=  true; 


oldmaxrowsum  :=  maxrowsum; 
end ; 

until  Finished: 

Scalar  Mult ( Psi , T , Psi , CNPoles ) ; 
Mat r ix- Mul t  (  A , Psi , Phi , CNPol es ) ; 
for  if*  to  CNPoles  do 

Phi [i , i J  : =  Phi  fi , il  +  1.0; 
r  i:=  1  to  CNPoIes  do 
Gamma[i]  :=  Ps i [ i , CNPo 1 es 1 ; 
single  Input  system  with  B  ve 


Gamma[ i 1  :=  Ps i [ i , CNPo 1 esl  ; 

{single  input  system  with  B 


vector  : 


/V.  sr'-Ss^' 


-•VJV*  V  >  V  V  *  -  *  *  •  -  *  ■  -J.  •  .  -  .  -  •  •  A. 


LE:  TIMEPLOT . PAS 


Program  Listing 

{  B=  £  0  0  0  0  ...  0  1]  (transpose)} 
Plottime  :=  0.0:  Plotindex  :  =  1;  (initialize) 
for  i:  =  1  to  CNPoles  do  Xold[ij:=  0.0; 

(init.  prev.  state) 

Ymax  :=  0.0;  Ymin  ;=  0.0; 

Boxuser ; 

for  N  : =  1  to  Nincr  do 

(begin  calculating  next  state  and  y) 

begin 

(compute  input  at  time  Plottime} 
case  Inputtype  of 

’S’  :  Uinput  :=  Amplitude; 

’R’  :  Uinput  :=  Plottime  *  slope  +  offset: 

’I’  :  if  plottime  =  0  then  Uinput  :=  amplitude 

else  Uinput  :=  0.0: 

’W’  :  Uinput  :=  Amplitude  *  sin(freq  *  plottime) 

end;  (case) 

Matr ix_Vector_Mul t ( Phi , Xol d , XNext , CNpoles ) : 

(compute  new  states) 
for  i : =  1  to  CNpolesdo  .  _ 

Xnext[i]:=  Xnext[i]  +  Gamma [ i ] * Uinput ; 
v : =  0.0; 

for  i:=  1  to  CNPoles  do 
begin 

if  abs(y)  <  1.0E07  then  y:  =  y  +  Cl[i]  *  XnextTi] 

else  y:=  1 . 0E07 ;  (max  y  limit) 

end: 

if  SizeZero  =  CNPoles  then 

y  :=  y  +  NumCoef f [SizeZer o+l ]  *  Uinput; 
if  y  >  Ymax  then  Ymax : =  y; 
if  y  <  Ymin  then  Ymin:=  y: 

if  N  mod  5=0  then  (plot  every  5th  point) 
begin 

ur aphArrav [ Plotindex . 1 3  :=  Plottime: 


Page  6 


( transpose  ) ) 
initialize ) 

•  0 ; 

state ) 


GraphArray  .Plotindex , 1 .  :=  Plottime; 

GraphArray  . Plotindex , 2.  :=  y: 

InputArray  .Plotindex , 1 .  :=  Plottime; 

InputAr ray [ Plot index , 2 J  :=  Uinput; 
Plotindex  :=  Plotindex  +  1; 


InputArray  .Plotindex, 1  . 
InputArray [Plotindex , 2. 


end : 

Plottime  :=  Plottime  +  T;  Xold 
end ; 

Ymax  : =  1.1  *  Ymax ; 

Ini tgraphic ; 

SelectWindow( 1 ) ; 

drawtext (20,20,1  ,  'O’  ); 
dr awtext (20,26,1  ,  ’U’  ); 
drawtext (20,32,1  ,  ’ T  ’  ); 
drawtext (20,38,1  ,  ’ P ’  )  ; 
drawtext (20,44,1  ,  ’ U ’  ); 
dr awtext ( 20 , 50 , 1  , ’ T ’  ) ; 

drawtext (250,195,1  ,  ’ T IME( sec  )  ’  )  ; 


Xnext ; 


NiceAxes(  0  ,  tmax  ..ymin  .ymax  ,  ’  ’  ) ; 

Selectworld(WoriaNdxulb ) ;  SelectWindow( WindowNdxGlb ) 

Dr awPolygon( GraphArray,1 ,-(Plotindex-1 ), 0,0,0); 
NiceAxes( 0 , tmax ,ymin ,ymax ,  ) ; 

Se tLineStyle ( 1 ) ;  (dashed  line  for  input  signal) 

■rv  ygQn(  InputArray,  1  ,  -  (  Plotindex-1  ), 0,0,0); 

$tyle( 0  )  ; 


DrawPol 

SetLine 
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repeat  until  keypressed: 

quit  :=  false; 

repeat 

Graph_Menu( ’Time-Response ’ , DumpGraph , qui t ) ; 

T»  ~  „  (calls  print/title  menu) 

If  DumpGraph  then  Pr intGraphData; 
until  quit; 

LeaveGraphic ; 


r~j  v^-  it.  v~k  Tr*^v-^  v„  V,  <^,  *r-^».’ 


■V-V'V  ^VJ 


FILS:  NYQUIST . PAS 

Program  Nyquist; 
label  1  ;  l  label  de 


Program  Listing 
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label  decleration  for  goto  statement) 
f.sys)  {graphics  routines) 


Typedef . sy s ) 
Gr aphix . sys ) 
Kernel . sys ) 
Windows . sys ) 
Polygon . hgh ) 
Axis . hgh ) 

Ut-mod01 . inc 
Ut-mod02 . inc 
Ut-mod03 . inc 

Gr apMenu .inc) 
Plotnyqs . inc ) 
Boxuser . inc  ) 


type 


ary4 

ary6 


(SI  Polynom.inc) 
($1  Rootf ind . inc ) 


(I/O  routines ) 


(graph  options  menu) 
(Nyquist  plotting  routine) 


=  array 
=  array 


of  real ; 
of  integer ; 


(Polynomial  routine) 

(Polynomial  roots  finder  routine) 


Code . I , Count , NumberDecades , 

Star t Decade . EndDe cade , one 
Wf ,Wo,Wi ,DeltaW,Gain 
PlotArrayl ,PlotArray2, 

MagPhaseAr ray ,  Fre q Array 

ZMagn , Z Phase , PMagn , PPhase , Phase 

TempX , TempY 

temp 

OpenLoop,  PicBig 
1,3  3 »kk1  ,m,l,sizezeros, CNpoles 
Dencoef  f , Numcoef f , cdencoef f 
realpartpole , imagpartpole , realpar 
crealpartpole , imagp art zero , cimagp 

plotf i le 

function  Log( X : real ): real ; 

(computes  the  base-10 

Begin 

If  X=0  then  Log:=0  else 
Log  :=  Ln(X)/Ln( 10); 

End; 


:  integer ; 

:  Real; 

:  PlotArray; 

:  real  ; 

:  real ; 

:  char ; 

:  boolean; 

:  integer  ; 

:  ary4  ; 
tzero. 

artpole:  ary3s  ; 
:  aryls; 

: file ; 


logarithm  of  X) 


function  Expon( Y , X : real ): real  : 

(computes  Y  rais 

Begin 

Expon  :=  exp(  X  *  (ln(Y))); 
end; 


begin 

Boxuser ;  one : = 1 ; 

Characteristic  equat ion( A1 A , size , 
for  i  :  =  1  to  si'Ze_do 
PSiri,size]:=B[i,1] ; 
for  jj:=2  to  size  do 
begin 

for  i : = 1  to  size  do 
begin 

1 : =size-j j  +  1  ; 


ed  to  X  power ) 


Dencoef  f ) ; 


kkl  :  =  j  +  1  ; 

PSlti  ,  j  J  : 


=Dencoef f [kk 1 ]  *  B[i,l]; 


A  Aa. 
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for  1:=1  to  size  do 
begin, 

PS I [ i , j ] : =  PS I [  i  ,  j  ]  +A1A[i,l]  *  PSl[l,kkl]: 
end; 
end ; 
end ; 

for  i : = 1  to  size  do 
begin  , 

Numcoeff [ i ] : =0 . 0 ; 
for  j:  =  1  to  size  do 
begin  , 

Numcoeff [i] : =  Numcoeff [i]  +  PSI[j,i]  *  C[l,l]; 
end; 
end ; 

for  i : = 1  to  size  do 
begin 

mt  =  size+l — i • 

if  Numcoefftm]  <>  0.0  then  goto  1; 
end  ; 

1  : sizezeros : =m-1  ; 

Clrscr  : 

Text Col or ( 1 ightblue ) ; 

writeln( ’  ***  Nyquist  Plotting  Parameters 

*  *  *  ’  ) ; Text Co lor ( ye  1 low) ; 


PicBig : =  false ;  ^ ’ 

Msg(’Open  (0)  or  (C)  Closed  Loop  Plot  ?’,5,5); 


repeat 

Input ( ’A’  *  ’ ,45,5.2. true, FI ,F10); 

temp : =copy ( answer , 1 , 1 ) : _ s 

if  not[temp  in  [’O’  ’C'])  then  Beep ( 950 , 350 ) ; 

until  temp  in  [’0’,’C’J: 
if  temp  =  ’0’  then  OpenLoop  :=  true 

else  OpenLoop  : =  false; 


Msg(’Graph  window  (B)  Big  or  (S)  Select  you 

size? ' ,5,7); 


r  own 


repe  3,^ 

input ( ’A’ , ’ ’ ,60, 7, 2, true, FI ,F10) : 

(sets  flag  OpenLoop  if  user  selects  the  open  loop) 
temp  :=  copy ( answer , 1 , 1 ) ; 

>  y>B’  j  ) 

»  ’  S  ]  ; 

then  PicBig  :=  true 
else  PicBig  :=  false; 


if  not(temp 
until  temp  in 
if  (temp  =  ’B 


then  beep ( 350 , 1 50 ) ; 


if  not  (picbig)  then 
begin 

Msg( ’ Input  your  first  frequency  to  be 
,  ,  plotted? ’  .5,9)  ; 

Msg( ’( example :  .01,  1,  100,  etc.) 

Input (  ’N’  ,  ’  ’  ,50,9,8, true  f  Fl  . FI  0 ) : 

Val ( answer , Wo , code );{ Wo  is  the  fi 


)  ’  .10,10); 
rst  plotted  freq) 


Msg( ’ Input  number  of  decades  do  you  want 

plotted? ’ ,5,12); 


Input ( ’N’ , ’ ’ ,50, 12, 2, true, FI , FI  0  )  ; 
Val ( answer , Number Decades , code ) ; 
end 
else 
begin 

wo : =0 . 00 1 ; 

Number Decades : =8 ; 
end : 
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root  finder (sizezeros, Numcoeff .realpartzero, 
imagpartzero , one ) : 

root  finder(size, Dencoef f , realpar tpole , 

~  imagpar tpole , one ) ; 

fain : = Numcoeff [sizezeros+1 ] ; 

or  i:=1  to  sizezeros+1  do 
t)  i  n 

Numcoef f [i] : =  Numcoeff [ i ] /gain ; 

end; 

clrscr ; Boxuser ; 


for 


for 

C 


? 


i:=1  to  maxorder  do  CDenCoeff[i]  : 
( initialize ) 

i : = 1  to  Sizezeros  +  1  do_ 
enCoeff[iJ  :=  NumcoeffLi]  *  gain; 
C.L.  denominator  equals  the  sum  of 
denominator  and  O.L  numerator) 


0.0; 


open  loop 


for  i:=1  to  Size  +  1 
CDenCoeff [i] 


if  Size  >  SizeZeros 


:=  CDenCoeff[i]  +Dencoeff[i] 

then  Cnpoles : =Size 

else  CNPOLES : =SizeZeros ; 


(compute  new  denominator  roots) 
root  finder ( Cnpoles , CDenCoeff , CReal Part Pole , 

—  CImagPart Pole , one ) ; 

StartDecade  :=  trunc ( Log( Wo ) ) ;  ,  . 

(compute  linear  scale  to  plot  ) 
EndDecade  :=  StartDecade  +  NumberDecades; 

(log  numbers.  Also  figure  step) 

Wf  :  =  Wo  *  Expon( 1 0 . 0 .NumberDecades ) ; 

Del taW  :=  Expon( ( Wf /Wo ) , 0 . 0 1 25  )  ; 

Wi  :=  Wo; 


for  Count  :=  1  to  81 

(do  81 


Begin 

if  OpenLoop  then 
(compute  bode  numbers 
closed  loop  ) 


do 

iterations. . .arbitrary 
if  openloop  and  later 


#y 

if 


begin 

ZMagn:=1.0;  ZPhase:=0.0; 

PMagn : = 1 . 0 ;  PPhase:=0.0; 
for  i  :=  1  to  SizeZeros  do 
(compute  magn  and  phase  of  zeros 
begin 

ZMagn:=ZMagn  * 


( initialize ) 

for  freq  step) 

Sqrt ( Sqr ( Real  Par tZero [ I ] )  +  _ 
r  Sgr (Wi - ImagPar tZero [ I]  ))  ; 

then 


if  ReairartZero[I]  =  0.0  - , 

ZPhase : =ZPhase+pi/2 . 0  else 
begin  _  _ 

if  realpartzero [i]  >  0.0  then 

ZPhase:=  ZPhase  -  pi _ +  ArcTanf ( Wi- 

ImagPartZero [i] )/( -Real  Par tZero[i] ) ) 


else 

ZPhase : =ZPhase+ 

ImagPartZero [ i J )/( 

end ; 
end ; 


£rQTqq>(^Wi- 


eal Par tZero [ i ]  )  ) 


for  i  : =  1  to  Size  do 

(compute  magn  and  phase  of  poles  for  freq  step) 
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be 


agn :  =  PMagn 


Sqr t ( Sqr ( Real  Par t Pole [ I] }  * 

_  Sqr (Wi-ImagPartPole [I j ) ) ; 
i[il  =  0.0  then 


if  RealPartPolei_J  _  _ 

PPhase:=  PPhase+pi/2 . 0  else 
begin  _  _ 

if  RealPart Pole [i J  >  0.0  then 

PPhase : =PPhase  -pi  +  ArcTan((Wi- 
Imag Par t Pole [i] )/( -Real  Part Pole [I] ) ) 

else 

PPhase :  =  _PPha.se+£r^^.rj.(  j[Wi- 


end; 

end; 


Imag Part Pole [i. 


-Real  Part Pole [ i] ) ) ; 


Phase 


TempX 

TempY 


=  Frac((ZPhase  -  PPhase )/( 2 *pi ) )  * 

cpdulo" 


=  ab  s  (  ( 

=  ab  s ( (  _ 
if  (PicBig)  and  (TempX 
if  (PicBig)  and  (TempY 


{ Phase  "me 
Gain  *  ZMagn / PMagn )*cosi 


Phase 


Gain*ZMagn/ PMagn ) *sin( Phase 


100)  then  TempX 


(2*pi  )  ; 
2Pi  ) 


100)  then  TempY 


: =  100; 
: =  100; 


If  Phase<0  then  Phase :*  Phase+( 2*pi ): 

If  ( ( Phase> (pi/2 ) )  and  ( Phase<(3*pi/2  )  )  )  then 

If  ((Phase>pi)  and  (  Phase<  ( 2*pi^iy^  then 

TempY  :=  -TempY; 


MagPhaseAr ray [count , 2[ 
MagPhaseArray [coun$ , 1 . 


PlotArrayl [Count , 1 J 
PlotArray2 [count , 1 J 


•  =  phas 0  * 

:=  Gai n* ZMagn/ Pmagn ; 
TempX; 

TempX ; 


PlotArrayl,  [[Count ,  2[ 

»  2  _ 


Wi 

end 


rioiAiray i loouiu 

PlotArray2 [count 
FreqAr ray [Count ,  1  ] 
=  Wi  *  DeltaW; 


TempY ; 
-TempY ; 


=  wi  ; 


(increment  freq  step) 


0  1  S  G 

(perform  same 


steps  as  above  if  closed  loop  requested) 


begin 

ZMagn : = 1 
for  i  := 
be 


)); 


0 ; ZPhase : =0 . 0 ; PMagn : = 1 . 0 ; PPhase ; =0 . 0 ; 

1  to  SizeZeros  do 

§Magn := ZMagn  #  Sqr t ( Sar ( Real  Par tZero [ II )■ 

Sqr (Wi - ImagPar tZero [ I J 
if  Real  Par tZero [ I]  *,0.0  then 
ZPhase : =ZPhase+pi /2 . 0  else 
begin  _  _ 

if  RealPartZero[I j  >  0.0  then  , , 

ZPhase : =ZPhase  -  pi  +  ArcTan( (Wi- 

ImagPar tZero [ i ] )/ (-RealPartZero[iJ  )  ) 

else 

ZPhase : =ZPhase+ArpTan( ( Wi- 


end ; 
end; 


ImagPar tZero [ : 


-Real  Par tZero[i] ) ) ; 


for  i  : =  1  to  CNpoles  do 
begin 

PMagn : =  PMagn 


if  CReal Part  Pole 


Sqrt( Sqr ( CRealPartPolel II ) 
S^r^Wi-CImagPartPole [ I] ) )  ; 


])  + 


0 . 0 


PPhase :=  PPhase+pi /2 . 0 


hen 

else 
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then 


begin  _  _ 

if  CRealPartPole[l] 

PPhase : =PPhase 
CImagPart Pole [ ij) 7 ( - 
else 

PPhase :  =PPhase+A^c^r^(  (Wi- 


>  0.0  - 

pi  +  ArcTan((Wi- 

CRealPartPole LiJ  )  ) 


CImagPart Pole [: 


CRealPartPole  [i]  )  )  ; 


end; 

end; 


Phase  :=  Frac((ZPhase  -  PPhase )/( 2*pi ) )  *  (2*pi); 

.  .  { Phase  "modulo"  2Pi) 

TempX  :=  abs( ( Gain*ZMagn/ PMagn ) *cos (Phase) ) ; 

TempY  :=  abs( ( Gain*ZMagn/ PMagn ) *sin( Phase )) ; 
if  (.PicBigl  and  (TempX  >  100)  then  TempX  :=  100; 
if  (PicBig)  and  (TempY  >  100)  then  TempY  :=  100; 


If  Phase<0  then  Phase : = , Phase+( 2 *pi ) ; 

If  ( ( Phase> (pi/2 ) )  and  ( Phase< ( 3#pi/2 ) ) )  then 

TemgX:=  -TempX; 

TempY  :=  -TempY; 


If  ((Phase>pi)  and  (Phase<2*pi 


PlotArrayl [Count , 1 1  :=  TempX; 

Plotarray2 [count , 1 ]  :=  TempX; 

PlotArrayl [Count , 2]  :=  TempY; 

PlotArray2 [count , 2 J  :=  -1.0  *  TempY; 


Wi  :=  Wi  *  DeltaW ; 
end; 

Plot_Nyquist ( St art Decade , EndDecade , 

Number Decades . FreqArr ay , PlotArrayl , 
Plotarray2 .MagPhaseArray , PicBig , OpenLoop ) 


Assign( Plotfile, ’Plot.COM’ 
Execute(plotf ile  ) ; 


); 


end.  (Nyquist) 
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Program  Root  Locus; 

(  This  program  plots  the  root  locus  of  the  plant  > 
label  1; (label  declerat ions  for  the  goto  statement} 

i$I  Typedef.sys)  (graphics  routines} 

$1  Graphix.sys} 

$1  Kernel . sys } 

$1  Windows. sys ) 

$1  Polygon. hgh) 

$1  Axis. hgh} 

($1  Ut-mod0 1 . inc , }  (I/O  routines} 

(SI  Ut-mod02 . inc } , 

($1  Ut-mod03.inc  } 

($1  GrapMenu . inc }  (graph  options  menu} 
type 

ary4  =  array  [1..11J  of  real; 
ary6  =  array  [1..21J  of  integer; 

Var 

I , J , code , LineCount  :  integer; 

Plot Pole , PlotZero  :  PlotArray; 


PlotRealPole , Plot ImagPole  :  ary3s; 

Del taGain , Star t Gain , EndGain , 

Variable  Gain  ,  Xmin  ,  Xmax ,  Ymin ,  Ymax  .gain  :  Real; 
Neg_Feedback , dumpgraph , qui t  :  Boolean; 


list  : 

i j , kkl .m, 1 , sizezeros , one  : 

holdpoly , dencoef f , numcoef f  : 

realpartpole , imagpartpole .realpartzero, 
imagpartzero  : 

PS  Is 

plotfile  : 


text ; 
integer ; 
ary4  ; 


ary3s 
aryl  s 
file; 


f 

9 


Polynom. inc } 
Rootf ind . inc } 


Procedure  PrintGraphData; 

(dumps  root  locus  data  to  printer} 

Begin 

LeaveGraphic ;  Clrscr; 
repeat 

Text col or (white ) ; 

PROGRAM  OUTPUT  OPTIONS  »** 


gotoxy^20 ,13); 
writeln(’<P>  Printer  output 
Text co lor (yellow) ;  gotoxy( 20,14); 
writeln( ’  Check  Your  Printer! 

Textcolor ( white ) :  gotoxy ( 20 , 1 5 ) ; 
writeln(’<F>  List  to  File  name 
gotoxy ( 20 ,16); 

writeln(’  on  the  current  drive 

gotoxy( 20 , 1 7 ) : 
writeln(’<Q>  Quit 

gotoxv( 42,15); textcolor (yellow); 
wr ite( > "RLOCI .RES" ’ ) ;  gotoxy (28, 1 
readCkbd, ch ) : ^  N 

If  ( ch  =  ’F5)  or  (ch  =  ’f’)  or  ( 


begin , 

if  (ch  = 
begin 


ch  =  ’ P ’ )  or 

( ch  =  ’ p ’ )  then 


)  or  ( ch  = 


)  then 
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begin 

writeln( list ,  chr(12)); 

LineCount  :=  0; 
end  ; 

variable  gain : =var iable  gain+del taGain ; 
end;  —  — 

end; 

until  ch  in  C’Q’.’q’]; 

EnterGraphic ; 
swapscr een : 
close( list ) ; 
d; 


££  XU 

one;=1 ;{Root  Locus  Input  handler  driver) 

P . 1  .  : =  ’ 5506N01 001 -01 01 01  ’  ; 

P.2.  ;=  ’ 5508N01 002-01 01  03 ’  ; 

P.3.:=  ’ 1 51 2N00503-01 01 01  ’  ; 

P .4. : =  ’ 1 51 3N00504-01 01 03 ’ ; 

P  .5.  : =  ’ 1 51 4N00505-01 01 01  ’  ; 

P.6.  :=  ’  1 51 5N00506-01 01 03 ’ ; 
p[7]:=  ’4517A00207T01 01 01  '  ; 

Clrscr ;  TextColor ( 1 ightb lue ) ; 

writeln  ’  ***  ROOT  LOCUS  PLOTTING  PARAMETERS  ***’); 

writeln?^Ye-l0W- 
writeln; writeln: writeln; 

TextColor (green): 

wr itein( ’ Input  STARTING  value  for  the  variable 
gain:  ’  )  ; 

wr i tsln * 

writeln( ’ Input  ENDING  value  for  the  variable 
;gain: ’ ) ; 

TextColor(yellow) ; 
writeln;  writeln; 


writeln;  TextColor ( green ) ; 
wr itelni ’ X-Minimum: 


writelnt  ’ X -Maxi mum : 
writeln! ’Y-Minimura: 
writeln! 'Y-Maximum: 


writeln ; 


writeln( ’ Positive  or  Negative  Feedback?  (P  or  N) 

Input_Handler ( ’N0107’ .Escape): 

(prompts  for  NEW  inputs) 

writelnjwr iteln ; 

writeln(  ’ Any  changes  to  these  parameters? 


wntein!  'Any  changes  to  these  parameters? 

,  (Y  or  N) :  ’  )  ; 

Input ( ’A’ , ' ’ ,45. 1 9,2, true, FI ,F10) ; 

If  answer= ’Y’  then  Input  Handier (’ C01 07 ’ , 

(prompts  for  changes) 


Escape ) ; 


Val ( f ilvar [ 1 ] . Star t Gain , code ) ; 

,  (converts  input  strings  into  numeric  values) 
Val ( f ilvar [21 , EndGain , code ) ; 


Val ( f ilvar .3 
Val! filvar .4 
Val( filvar  .5 
Val(filvar  6 


Xmin .code 
Xmax , code 
Ymin , code 
Ymax , code 


If  copy ( f i lvar [7] , 1 , 1 )  <>  ’N’  then 

Neg  feedback  :=  false 
else  Neg_feedback  :=  true; 

INITGRAPHIC :( define  values  for  graphics  routine) 
NICEAXES( xmin , xmax , ymin , ymax , ’ ’ ); 


,  xmax , y m i n , ymax , 
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Characteristic  equat ion( A1 A , size , dencoef f ) ; 
(calculate  denCoeff  from  the  plaint  matrices) 
for  i:=1  to  size  do 

(calculate  numcoeff  from  the  given  plant  matrices) 
begin 

FSI  [i .size] :=B[i , 1 ] ; 
end; 

for  ]]:=2  to  size  do 
begin 

for  i:=1  to  size  do 
begin 

PS 1 £ i , j  J : = dencoef f [kkl ] 
for  1:=T  to  size  do 


*  B  [  i  ,  1  ] 


begin , 


»  nr  2,  n. 

PSI [i.J]:=PSI[i,j]  +A1 A [ i , 1 ]  »  PSI[l,kkl]; 
end ; 
end; 
end; 

for  i:=1  to  size  do 
begin 

nuiuooeff  [i]  :  =  0 . 0  ; 
for  j  :  =  1  to  size  do 
begin 

numcoeff [i] :=numcoeff [i]  +  PSI[j,i]  *  C  [  1  ,  j  ]  ; 
end; 
end; 

for  i:=1  to  size  do 
begin 

ms  =  s i Z6  + 1 -i • 

if  numcoeff£m]  <>  0.0  then  goto  1; 
end : 

1 : sizezeros : =m- 1 ; 

(calculate  the  zeros  of  the  system) 
root_f inder ( sizezeros, numcoeff , realp artzero, 
imagpart zero, one) ; 


gain : = numcoeff [sizezeros+1 ] ; 

(convert  highest  degree  numerator  coefficient  into  1.) 


for  i:=1  to ^s^z^zeros+1  do 


numcoeff [i  J : =numcoef f [i] /gain; 
to  sizeZeros  do 


For  I : = 1 
Begin 

PlotZero [ I , 1 ]  :=  Real  Par t Zer o [ I ]  ; 

PlofZero [ I , 2]  :=  ImagPartZero[I] ; 


end;  (for 
Case  sizeZeros  of 
0 


1 


begin 
PlotZe 
Plot Ze 
PlotZe 
PlotZero 


.2,1. 

:  =  Plot Zer o 

.1,1. 

.2,2. 

:  =  PI otZero 

.1,2. 

.3,1. 

: =  PlotZero 

.1,1. 

[3,2. 

: =  PlotZero 

[1  ,2] 

(xmin. xmax , ymin 

,  vmax 

—  -  —  - v  o - '  -  '  '  ' 

end ; 
begin 

FlotZero[3, 1 ] :=PlotZero[l , 1 ] ; 
PlotZeror3,2J:=PlotZero[l ,2] ; 


NICEAXES( xmin . xmax.ymin ,ymax , ’ ’ ) : 
DrawPolygon( PlotZero, 1 ,-3,-3, 3,0); 
d; 

NICEAXES( xmin . xmax , ymin , vmax , ’ ’ ) ; 
DrawPolygon( PlotZero, 1 .size Zeros, -3, 3,0); 


end ; 
else 
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LE:  RLOCI.PAS 

end;  (case) 

Variable  Gain  :=  StartGain; 

DeltaGaiTT  :=  (  EndGain-Star tGain  ) /50  : 
{divide  gain  to  plot  50  points) 


For  J  :  =  1  to  50  do 

(calculate  and  plot  50  points  per  graph) 
Begin 

HoldPoly  :=  dencoeff; 


If  Neg  Feedback  then 

For  I:=  1  to. SizeZer os  +  1  do, 

HoldPolyll]  :=  HoldPolyril  + 

(gain*Variable_Gain  *  numcoeff [I 


else 
For  I :  = 
HoldPol 


1  to_,Siz 

ly[lj  := 

(Gain  * 


SizeZeros  +1 ndo 
HoldPoly [I J  - 
Variable  Gain 


]) 

numcoeff [ I]  )  ; 


Root  Finder (size, HoldPoly, PlotReal Pole, 
Plot  I mag Pole , one ) ; 


For  I: si  to  size  do 

(fill  plotting 

Begin 

Plot Pole [ I , 1 ] 

Plot Pole [ I . 2] 

end ; 

AxisGlb  :  =  true; 

Case  size  of 

(artificially  fill 
than  3  points) 

0 
1 


matrix  with  poles) 

3; 


=  PlotRealPole C I 
=  PlotImagPole[I. 


plotting  array  if  fewer 


.2,1. 

:=  Plot  Pole 

.2,2. 

: =  Plot  Pole 

.3,1. 

: =PlotPole 

[3,2. 

: =PlotPole 

(.  xmin  .  xmax ,  ymin  , 

begin 

Plot Pole 
Plot Pole 
Plot Pole 
Plot Pole 
NICEAXES 
DrawPoly^-- 
end: 

2:  begin 

PlotPole [3 
PlotPole  f3 , ^  j 
NICEAXES( xmin . 
DravPolygon( PlotPole  ,  1 
end; 

6  1  S  @ 

NICEAXES( xmin , xmax.ymin , 
DrawPolygon( Plot Pole  ,  1  ,  s 
end:  (case) 

variable  gain: =variable  gain  +  De 
end; 


1  ] : =  PlotPole 
J : =PlotPole 
xmax.ymi 


E1  , i ]  ; 
[1  ,2]  ; 


n , ymax , ’ 
,-3,-1  ,3 


ymax , ’ ’ ) 
lze , - 1 ,3 

1 tagain ; 


0) 


Repeat  until  KeyPressed; 
quit  :=  false; 

repe  p 

Graph  Menu( ’Root  Locus ’ .DumpGraph , quit ) ; 

(calls  print/title  menu) 

If  DumpGraph  then  Pr intGraphData ; 
until  quit: 

LeaveGraphic :  s  ,  , 

Assign(plotfi le plot . com ’) ;  (re-execute  plot.com) 
Executed plotfile ) ; 
ad.  (root  locus) 
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Program  Roots; 

label  1;  { label  declerat ion  for  goto  statement) 


of  real ; 
of  integer ; 


i$I  Typedef.sys) 

TYPE 

ary4  =  array  [1..11]  of  real; 
ary6  =  array  [1..21J  of  integer; 

var 

posCounter ,  i  ,  j ,  j  j ,kk1 , m , 1 , 
cnpoles , sizezeros , one :  integer; 
dencoef f , numcoeff , cdencoef f :  ary4 ; 
realpartzero , imagpartzero. 
crealpartpole , cimagpar tpole  :  ary3s; 
PSI  :  aryls; 

plotfile  :file; 
gain  : real ; 


($1  Polynom.inc) 
($1  Rootf ind . inc ) 


BEGIN 

ClrScr ;  one : = 1 ; 

Characteristic  equation( A1 A , size , Dencoef f ) ; 
for  i:  =  1  to  si'Ze  do 
PSI[i,size]:=B[i,l] ; 

for  11:=2  to  size  do 
begin 

for  i : = 1  to  size  do 
begin 

f :  =size- j j +1  ; 

kk1:=1+l;  .  _ 


Kkl  •  =  j  +1  * 

PSlti.JJ : =Dencoeff [kk 
for  1 : = l  to  size  do 


1  ]  *  B  [  i  ,  1  ]  ; 


befsi[i,j] :»PSI[i,j]  +A1 A [ i , 1 ]  *  PSI [ 1 , kk 1 ] ; 
end; 
end; 
end; 

for  i : = 1  to  size  do 
begin  _  _ 

Numcoeff[i] :=0.0; 
for  j:=1  to  size  do 
begin 

Numcoeff [i] : =Numcoeff [i]  +  PSI[j,i]  *  C[1,j]; 
end ; 
end ; 

for  i:=1  to  size  do 
begin 

j  =size-f  1 _ i  • 

if  numcoeff tm]  <>  0.0  then  goto  1; 
end : 

1 : sizezeros : =m- 1 ; 

root_f inder (sizezeros, Numcoeff .realpartzero, 
imagpartzero , one ) ; 

?ain:=  Numcoeff [sizezeros+1 ] ; 
or  i : = 1  to  sizezeros+1  do 

Numcoeff [i] : =  Numcoeff [ i ] /gain ; 
end ; 


for  i:=1  to  maxorder  do 
CDenCoeffLii  :=  0. 
for  i:=1  to  Sizezeros  + 
CDenCoeffti]  :=  Num 


axorder  do 

f L i J  :=  0.0;  (initialize) 
izeZeros  +  1  do,  „ 

[ij  :=  Numcoeff[i]  *  gain; 


W.V.V.V.Y.  V.V,  ^  ^^r^ntV'rK'il.’X’(irX.'VVVVW'A"\\V.VVVV  V  .’.V,  .,  .'.-.v.v.v.v  V  '.-'V  .-  .-v.-»Y».p 
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for  i : = 1  to  Size  +  1  do 

CDenCoeff [i]  :=  CDenCoeff[i]  +  Dencoeff[i]; 

if  Size  >  SizeZeros  then  CNPOLES : =Si ze 
{NPoles  should  always  be  greater) 

else  CNPOLES : aSizeZeros ; 


,  ,  {compute  new  denominator  roots) 

root_f inder ( Cnpoles , CDenCoeff , CReal Part Pole , 
CImagPartPole , one ) ; 

ClrScr ;  t ext col or ( 1 ightblue ) ; { on-screen  titles  ) 
wr iteln( ’  ***  Plant  Characteristic  Equation 

writeln:  wr iteln jhighvideo ; 
writeln! ’ROOTS  OF  THE  NUMERATOR:  ’); 

For  I : = 1  to  SizeZeros  do  {position  for  output) 
begin 


PosCounter  :=  (I  mod  2)  ; 

If  PosCounter  =  1  then  writeln; 


LowV 

writ 


wr 

end; 


wVideo;  {write  zeros  > 

ite(  ’ s[ ’  ,  I ,  ’  ]  =  ’ .RealPartZeroII] : 1 0 : 3 , 

ite  ’  +j  ’ , ImagPartZero [ I ] : 10:3); 


writeln:  writeln:  HighVideo: 
writeln( ’ ROOTS  OF  THE  DENOMINATOR:  ’); 


For  I:=1  to  CNPoles  do 
begin  {compute  o 


PosCounter  := 
If  PosCounter 


LowVideo ; 


compute  on-screen  position) 
:=  (I  mod  2)  ; 

1  then  writeln; 


wr 

end; 


write(  ’  s  [  ’  ,1,  ’  1  =  CReal  £>ART?OLEf  ??*?<£ : 

’  +j  ’  ,ClmagPARTPOLE[l] : 1 0:3)  ; 
write!  ’); 


f  or  ) 


HighVideo ; got oxy( 1 , 24 ) ; 

write! ’ Press  any  key  to  continue  or  [Shift]  [PrtSc] 
for  hardcopy.’); 

{check  keyboard  buffer  for  value  change. 

If  number  changes  by  1  or  2  indicates  that  shift  key 
depressed.  If  so,  then  remove  "Press  any  key..." 
prompt  from  screen  so  it  won’t  print  to  printer) 

keyold  :=  mem[0000 : 1 047] ;  not  erased  :=  true; 

Repeat  ~ 

key  : =  mem[0000 : 1 047] ; 

if  ( (key=keyold  +  1 )  or  (key=keyold  +  2))  and 
(not  erased)  then 
begin 

GotoXY( 1  , 24  )  ;  write!’  ’:80); 

not  erased  :=  false; 

endT 

Until  KeyPressed; 

Assign! p lot f ile , ’Plot.com’ ) ; 

Execute ( plot fi le ) ; 

end.  {Program  Roots) 


’.'■  wFrxmnFmy9w' 


FILE:  MATRIX. PAS  Program  Listing 

Program  Matr ix_Manipulation( input , output ) ; 

($1  Typedef , SYS } 

<$I  Box. INC) 

($1  Ut-mod0 1 . INC) 

var 

help3file, inversef ile , determinf ile , 
Polynomf i le , eigenf i le  : 

Procedure  Matrix  mathematics  menu; 


Page  1 


f  ile  ; 


i  .Tab 

Okchoice 

Finished 


Integer : 

Set  Of  Char 
Boolean ; 


Procedure  Menul tem( Pick : Char ; Descr ipt i on  :Str80; 

Color : Integer  ) ; 


Begin 


Text Col or ( color  )  ; 

Write  (’  *:tab,  (’);  TextColorC white  )  ;  Writ 
TextColor (color  )  ;  WritelnC ’  )’  .Description); 


te( pick ) ; 


End ; 


Begin 

ClrScr:  Text Color ( whi te ) ;  Finished  :=  False; 
GoToXY (  1  9 . 4J>  : 

Wr  ite(  ’  *  *  *  MATRIX  MATHEMATICS  MENU  ***’); 


Wr ite(  ’  *  *  *  MATRIX  MATHEMATICS  MENU  ***’); 
for  i  : =  1  to  4  do  writeln( ’  ’  ); 

Tab  : =  1 6 ;  . 

Menultem( ’ D ’,’ Determinant  of  A  Matrix’  yellow) ; 
Menultem( ’C’ , ’Characteristic  colynomial  of  A 

Matrix’ .yellow) : 

Menultem( ’ I’ , ’ Inverse  of  A  Matr ix ’ ,yel low ) : 

Menultem( ’ E Eigenvalues  of  A  Matr ix yel low ) ; 
Writeln; 

Wp i teln * 

Menultemf ’ H ’ , ’ Help ’ ,1 ightmagenta ) ; 

Menul tem( ’ Q ’,’ Quit  to  SVS  Main  menu  ’, 1 ightmagenta ) ; 
TextColor ( green) ; 

Texi Co lor? white ) ;  GoToXY  (40,22); 

Repeat 

Option; 

until  ch  in  [ ’ D ’ , ’ C ’ , ’ I ’ , ’ E ’ , ’ H ’ , ’ Q ’ ] ; 
case  ch  of 

’ D ’ :  begin  _  . 

AssignC determinf i le , ’ determin . chn ’ ); 

Chain ( determinf i le ) ; 
end : 

’ I ’ :  begin  ,  . 

Assigni inversef i le, ’inverse. chn ’ ) ; 

Chain ( inversef i le ) ; 
end } 

’ C ’ :  begin 

AssignC  Polynomf i le ,  ’ Polynom . chn ’  ) ; 

Chain ( Polynomf ile ) ; 
end : 

’ E ’ :  begin 

Assigmeigenfile,  ’eigen,  chn  ’  ) ; 

Chain ( eigenf i le )  ; 
end ; 

’ H ’ :  begin 

Assign( help3File , ’ help3 . CHN ’ ) ; 

ChainC help3File ) ; 
end; 
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’ Q ’ :  begin 

Assign( SvsFi le , ’ svs . COM ’ ) ; 
Executes SvsFile  )  ; 
r  end: 

End;  (case) 

End ; 

Begin  {main  program) 

Clrscr  ; 

Repeat 

begin 

Matrix  Mathematics  Menu; 
end;  —  ~ 

Until  Finished  =  True; 

End. (main  program) 


m 


FILE:  DETERMIN . PAS  Program  Listing 

Program  Matrix  Determinant  input ,outi 
label  10  ;  labej.-20  ;  label  30;label  40; 
label  70 ; label  80; 

<$I  Typedef . SYS } 

(SI  Ut-mod0 1 . INC } 

($1  Boxuser . INC } 


matrixfile  :file; 
list  :text; 


Page  1 

)ut  )  : 

- abel  50;label  60; 


counter >i>j,ii,k,m,n,even  : integer ; 

temp  value .value , det , det  correction, 
deteFminant_ol  d  ,  determinant  :real; 


At  - — m  w  .  .  i  ^  <3.  ± 

Begin  : aryls; 

counter  : =  0 ; 

Boxuser : 

for  i:=1  to  size  do 
Begin 

for  j : = 1  to  size  do 

®e§1?i,j]:=  A1 A [ i , j ] ; 

End; 

End ; 

for  i:=  1  to  size  do 

30:  if  A1  [It,  1]  <>  0.0  then  goto  10; 

K!=1‘C+1* 

if  (k-size)  <=  0.0  then  goto  30; 
goto  40: 

(i'k)  >  0-0  then  goto  40; 
if  (i-k)  =  0.0  then  goto  70; 
i or  m: = 1  to  size  do 
Begin 

ferno  value ;=A1 [i ,m] ; 

A1  Li , ml  : =  A 1  [k,m] : 

A 1  Lk , mj : =  t emp  value; 

End; 

counter : =  counter+1; 

7  0  :  i  i  :  =  i  + 1  ; 

if  ii  >  size  then  goto  20; 
for  m:=ii  to  size  do 
Begin 

if  A1[m.il  =  0.0  then  goto  80; 
value : =A1 [m, ij  /  A1[i,iJ; 
for  n:=  i  to  size  do 
Begin 

A 1 [m , n] : =  Al[m,n]  -  A1[i,n]  »  value; 
End ; 

80 : End ; 

20 : End; 
det : = 1 . 0 ; 

for  i:=1  to  size  do 
Begin 

aet:=det  *  A1[i,i]; 

End; 

det  correction::  exp(  counter  *  LN(1)); 
determinant  old:=det  correction  *  aex; 
even:*  counter  mod  2T 
if  even  <>  0  then  goto  60; 
determinant  :=  determinant  old; 
goto  50;  - 

60 : determinant : = -determinant  old; 
goto  50;  - 

40 : determinant : =0 . 0  ; 

50 : clrscr ; wr i teln ; TextColor ( yel low ) ; 
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Writeln! ’The  given  matrix  is  :  ’);  writeln; 

for  i:=  1  to  size  do 
Begin 

for  3 : =  1  to  size  do 
Begin 

write!  ’  ’  , A1 A[i , j ] : 1 1  )  ; 

End;Writeln; 

End; Writeln ; Writeln ; 

Write! ’The  determinant  value  is  :’): 

Text Co lor ( white ) ;writeln( determinant) ; 

keyr ead( key , key old , no t_e rased ) ; 


Repeat 

box  pr inter ;gotoxy ( 58 , 1 5 ) ; 
writelnf ’ "DETERMIN , RES" * ) ; 


textcolor(yellow) 


X  O^XilV  x  XJXWi  x  aw  . 

gotoxy! 1 ,25) ; write! ’ 
gotoxv! 49 , 1 7 ) ; 
read( kbd , ch 


;ad( kbd, ch ) ; 

>  (ch=’F’)  or  (ch=’f’)  or  (ch=’P’)  or  ( ch= 
then  begin s 

if  (ch=’F’)  or  (ch=’f’)  then 
begin 

gotoxy (45 , 1 5 ); textcolor ( red ) ; 

write(  ’  PRINTING .  ,  ’  )  ; 

Assign( list. ’Deter min. RES ’ ) ; 

Rewrite! list ) ; 
end: 

if  (ch=’P’)  or  (ch=’p’)  then 

begin  ,  .  . 

gotoxy (45 ,13); textcolor (red); 
write!  ’ PRINTING.  .......  ’  )  ; 

Assign(list. ’ LST : ’ ); 

Rewrite! list ) ; 
end ; 

writeln! list  , ’  v  DETE1 

RESULT  * ) ; 
writeln! list ) : 

writeln! list . 5  The  given  matrix  is:’); 

writeln! list  5 ; 

for  i:=1  to  size  do 


DETERMINANT 


begin 

for  ;j:  =  1  to  size  do 

begin  ,  _  _  . 

write(list,’  ’  , A1 A [ i , j ] : 1 1  ) ; 
end; writeln! list )  ; 
end: writeln! list) ; writeln! list)  ; 
Write( list The  determinant  value  is 
writelmlist.  determinant) ; 
writeln! list ) ;writeln\ list )  ; 
close! list ) ; 
end; 

Until  ch  in  [ ’ Q ’  ,  ’ q ’ ]  ; 


Assign!  matr  ixf  i  le  ,  '  mat  r  :  :<  . 
Execute ( mat rixfile  >  : 


End . 


r 
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FILE:  INVERSE. PAS  Program  Listing 


Program  Matrix  inverse( input , output ) ; 
($1  Typedef.SYS) 

(SI  Ut-mod01 . INC) 

{$1  Boxuser .inc) 
type 


var 


ary4 

ary6 


=  array 
=  array 


C 1  .  . 1  1  ] 
[1 . .21] 


of 

of 


real ; 
integer ; 


matrixfile  rfile; 
list  :text; 

polynom  coeff  :ary4; 

AinversS  : aryls; 

singular , step , stepper  : integer; 


{$1  Polynom. inc) 
{$1  Inverse. inc) 


begin 

clrscr:  Boxuser;  singular :=0; 

characteristic_equation(A1 A, size , Polynom_coef f ) ; 

inverse_f ind_matr ix( A1 A .polynom  coef f . si ze , Ainverse , 

polvnom  c^eff , singular ) ; 
clrscr ; textcolor (yellow) ;  ~ 

writeln(’The  given  matrix  is:  ’);  writeln; 
for  step:=1  to  size  do 
begin 

for  stepper :*1  to  size  do 
begin 

write( ’  ’ ,A1 A[step , stepper] : 1 1  ) ; 

endjwriteln; 
endjwr iteln ; 
if  singular* 1  then 

writeln( ’The  matrix  is  singular.’) 

else 


begin 

writeln(’The  inverted  matrix  is :’); writeln ; 
for  step:=1  to  size  do 
be^in 


or  stepper :  =  1  to  size  do 
begin 

wr  ite( ’  ’ , Ainverse [step , stepper] : 1 0 , 

end;writeln; 
end; 
end; 


) ; 


keyread(key ,keyold,not_erased) ; 

box  printer jgotoxy (58, 1 5 ) ; textcolor (yellow) ; 
writelnC’ "INVERSE. RES'* ’) ;  gotoxy ( 1  , 25  ) : 
write( *  5 ) ; 

«otoky(49’ 17) ; 
read(kbd, ch ) ; 

or  (ch=’f’)  or  (ch=’P’)  or  (ch=’p 
f ’ )  then 


_  ,  ,  cbd,  ch 

if  ( ch= ’ F ’ )  v 
then  begin x 
if  (ch= ’F’ )  or  (ch= 
begin 


gotoxy( 45 . 1 5 ) ; textcolor ( red) ; 
write(  ’  PRiNTING . . 


Assign( list , ’ inverse . RES ’ ) ; 
Rewritetlis-t) ; 
end ; 


); 


if  (ch=’P’)  or  (ch=’p’)  then 


wv 


FILE:  INVERSE. PAS  Program  Listing 

gotoxy( 45,13) ; text color ( red) ; 

write( *  PRINTING. ... - 

Assign( list , ’  LST : ’ ) ; 

Rewrites  list ) ; 


Page  2 


»  •  •  •  • 
) ; 


Rewrites  list ) ; 

6wr iteln( list , ’  .  MATRIX  INVERSE 

RESULT  ’ ) ; 

writelnl list ) :  .  . 

writelnl list The  given  matrix  is:’); 

writeln( list } ; 

for  step:=1  to  size  do 

begin 

for  stepper:=1  to  size  do 
n 

write( list . ’  ’ ,A1 A [step .stepper] : 1 1 ) ; 

end; writeln( list ) ;  ,  , 

end :writeln( list ) ;writeln(list); 
begin  . 

writeln( list The  inverted  matrix  is:’); 
wr iteln( list ) ; 
for  step:=1  to  size  do 
begin 

for  stepper :=1  to  size  do 
begin 

write(list,’ 

AinverseLstep, stepper] :  10, ’  ’); 

end;writeln( list ) ; 
end; 

wri-fceln(list);writeln(list); 
close( list ) ; 
end; 

Until  ch  in  [ ’Q’ , ’q’ ] ; 

Assign(matrixf ile , ’matrix.com’ ); 

Executed mat rixf ile ) ; 


end. 


- 
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Program  Listing 


rogram  Matrix  Manipulation  input , output ) ; 
$1 Tvpedef .SYS) , 

$1  Ut-mod01 . INC ) { $1  Boxuser.inc) 


type 


ary  4 
aryf 
ary6 


array  .1 
array  .1 
array  [1 


..11,  of  real ; 

.  . 21 .  of  real ; 

.  .  21  J  of  integer ; 


var 


matrixfile  :file; 
list  :text: 

c2,C1  :ary4; 

RealPart , ImaginaryPart : ary3s ; 
i ,  j ,one  : integer ; 


{$1  Polynom. inc > , 
(SI  Rootf ind. inc } 


begin 

clrscr : Boxuser ; one : = 1 ;  / 
characteristic^ equation(A1 A, size , Cl ) ; 

root  Finder(size,C1 .RealPart, ImaginaryPart , one ) ; 
clrsUr ;Textcolor!yellow) ; 

writeln! ’The  given  matrix  is : ’ ) ;writeln; 

for  i:=1  to  size  do 

begin 

for  j:  =  1  to  size  do 
begin  ,  _ 

write(  ’  ’ , A1 A[i , J ] : 1 1 ) ; 

end;wr iteln ; 
end: writeln ; writeln ; 

writeln! ’The  eigenvalues  of  the  matrix  are:  ’) 


wr iteln( 

for  i : » 1 
begin 
write 


to  size  do 


IMAGINARY  PART ’ ) 


write( RealPart [i] : 3 ) ; 


REAL  f*ART 


); 


write 

write 

end; 


ImaginaryPar 


art[i] : 3  ^  I 


writeln; 


keyread(key ,keyold,not_erased) ; 
Repeat 


geat 

ox  printer ; gotoxy (58 ,15); text col or (yello 
writeln! ’ "EiGEN. RES" ’) ;  gotoxy! 1 , 25  ); 
write!  ’  ’  ) ; 


low)  ; 


«°toxv(49,17); 
rea^(kbd^ch ) ; 


if  (ch* 


.  ,  or  (ch*’f’)  or  (ch=’P 

then  begin % 

if  (ch= ’F’ )  or  (ch=’f’)  then 
begin 

gotoxy ( 45,15); text col or ( red) ; 

write!  ’PRINTING . , 

Assign! list , ’ Eigen . RES ’  ) ; 
Rewrite! 1 isi ) ; 

if  (ch«’P’)  or  (ch=’p’)  then 
begin 

gotoxy! 45,13);textcolor(red); 
write! 'PRiNTING. ... _ 


)  or  ( ch* ’p ’ ) 


Assign! list , ’ LST : 
Rewrite! list); 
end; 


Vi 


FILE:  EIGEN. PAS 

writeln( list , 


Program  Listing 


wr  iteln 
wr  iteln 
wr  iteln 
for  i  :  = 
begin 

for  j : = 1 
begin 

wr  ite( lis 


v  RESULT 
list ) : 
list,  5 
list): 
to  size 


); 


Page 

EIGENVALUES 


The  given  matrix 
do 

to  size  do 


is : *  ) ; 


, A1 A[i , j ] : 1 1  ); 


end;writeln( list ) ; 
end:writeln( list);writeln(list); 
wri-telnClist,  ’ 

The  eigenvalues  of  the  matrix^are 


■iteC list ,  ’  _  _ 

iteilist, Real Part [i] : 1 0 ) : 
ite( list , ’  +  I  r  *  ):  . 

■ite( list , ImaginaryPart [i J : 1 0 ) ; 


wr iteln( list, ’ 

IMAGINARY  PART  »  ) ; 
for  i:=1  to  size  do 
begin 

write( list , 
wr  ‘ 
wr 

wr  _  _ 

wr iteln( list ) ; ~ 
end:  y  , 

writelnili st); write In (list); 
closet list ) ; 

Until ’ ch  in  [ » F ’ , » f * , ’ P • , » p ’ , * Q * 

Assign(matrixf ile , ’matrix.com’ ) ; 

Execute ( mat r ixf ile ) ; 


REAL 


); 


PAR^' 


’  q’  ] ; 


end. 
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’rjogram  Matrix  Character istic_Equation(  input ,  output ) ; 

II  U?-mod01 . INC) 

II  Boxuser.inc) 
type 

ary4  =  array  [1..11J  of  real; 


ary6 


=  array 


of  integer; 


var 


Cl 


matrixfile  :file; 
list  :text; 


: ary4 ; 

: intege 
: string 


lh: 


i  ,  d  . vertpos , horizpos , poscounter 
exponent 

($1  Polynom.inc) 

begin 

clrscr ; Boxuser ; 

characteristic  eauation( A1 A , size , Cl );clrscr; 
Textcolor (yellow) ;  writeln; 
writelnt’Tne  given  matrix  is  :  ' );writeln; 

for  i:=1  to  size  do 
begin 

for  d :=1  to  size  do 
begin  ,  _ 

write(’  ’ ,A1 A[i ,d] : 1 1 ) ; 
end; writeln ; 
end: writeln ; writeln : 

writeln(’The  characteristic  polynomial  of  given 
matrix  is: 
vertpos : =size+7 ; 
for  i:=size+1  downto  1  do 
begin 

j  •  =size+1 -i * 

poscounter : =(d  mod  4)  +1 ;horizpos : -poscounter  * 


14; 


if  poscounter  = 
if  i  <>  1  then 
begin 


1  then  vertpos : *vertpos+2 ; 


gotoXY(horizpos-1 0 .vertpos ): write (Cl [i] :7:4 ) ; 
msg( ’  S  +’ .horizpos .vertpos ) ; 
str(i-1 : 2 , exponent ) ; 
msg( exponent ,horizpos+1 ,vertpos-1 ); 
end 
else 
begin 

§otoXY( hor izpos-1 0 .vertpos ); write (Cl [il : 7 : 4  ) ; 

; 

end; 

keyread(key .keyold, not_erased) ; 

Repeat 


peat 

5?hg!^l«Hg?S8^1l«l?l!textoolor(yeilov>! 
T 
5 


«o^oity[^25 


f  ’  )  or  ( chs 
f ’  )  then 


: wr ite( 

read(kbdj,  ch  ) ;  '  , 
if  (ch-’F’)  or  (ch= 
then  begin 
if  (ch-’F*)  or  ( ch= 
begin 

gotoxyf  45,15); text col or ( red) ; 

write( 'PRINTING . 

Assign( list , ’ Polynom.RES ’ ) ; 
Rewrite(lis-fc); 
end; 


1  00 


); 


P’  )  or  (ch= ’p ’  ) 


); 


i  -***  ■>  «  -V  A*  Sjl£  *  i  JfcnJt  A 


LE:  POLYNOM. PAS 


Page  2 


Program  Listing 

if  (ch=’P’)  or  (ch»’p’)  then 
begin 

end: 

wr iteln( list , ’ 

,  „  RESULT  » ) ; 

writeln( list ) : 

writelm list The  given  matrix  is: 

writelnc list ) : 

for  i:=1  to  size  do 

begin 

for  j : = 1  to  size  do 
begin 

write(list, ’  ’  A1 A[i , j ] : 1 1 ) ; 


POLYNOMIAL 


write( list . ’  ’ , 

end; writelnc list ) ; 
id : writelnc list );wr 
■i te( 1 ist ,  The  char 
,  given  ma 
•iteln( list . ’  X  Des 
•iteln( list) ; 

>r  i:=size+1  downto 


iteln( list ) ; 
acteristic  p< 


writeln( list .  ’  (  Descend 
writeln( list ) ; 
for  i:=size+1  downto  1  do 
begin 

write(list,C1 [i] :  7 : 4 , ’ 
str(i-1 : 2 , exponent ) ; 


characteristic  polynomial  of 
n  matrix  is : ’ ) ; 

Descending  power  of  S  )  ’  ) ; 


str(i-1 : 2 , exponent ) ; 
end; 

write In (list); write In (list); 
close( list ) ; 
end;  _  _ 

Until  ch  in  C’Q’.’q’]; 

Assign(matr ixf ile , ’matrix.com’ ) ; 
Execute (mat rixf ile ) ; 


/vri.^^jvyvyyi,-*  vrir*1  ^3.'’  jt’jt' jr*> ’'jf  \y 
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frogram  Control ( input , output ) ; 

$I,Typedef .SYS) 

#  {Program  type, and  variable  definitions) 
($1  Ut-mod01 .INC)  {input  utility  programs) 


type 


Aryl 


=  Array [ 1 .. 1 1 , 1 .. 1 1 ]  of  real; 


Stepping, Steps , step , steppings , 
Tempi ,Temp2 , value 1 , value2 ,m,mpli 
last  rank, k, value 1  plus ,kplus 
new  matrixl  ,new  matrix2 


big- matr ix 
list 


: integer ; 
: aryl s ; 
raryl  ; 

: text ; 


{$1  control. inc)  {finds  controllability  result) 

{$1  Boxuser.inc) 

Begin 

valuel  :=  1;  value1plus;=  value  1 ; 

ClrScr ;Textcolor(yellow) ; 

Writeln(’The  A  matrix  is  :  ’ );writeln; 

For  steps  :  =  1  to  size  do 
Begin 

For  stepping  :=  1  to  size  do 

e$rite( ’  ’ , A1 A[steps , stepping] : 1 1 ) ; 

End;  Writeln: 

End: writeln; writ eln : 

WritelnC’The  B  Matrix  is  :  * );writeln; 

For  steps  :  =  1  to  SIZE  do 
Begin 

for  stepping: *1  to  ni  do 
begin 

Write( ’  ’ ,B[steps, stepping] : 1 1 ) ; 

end;writeln; 

End ; writeln : writeln ; 

For  steps :=1  to  size  do 
Begin 

For  stepping  :*1  to  ni  do 

Begin  _  _  _  .. 

new_matr 1x2 [steps , stepping]  :*  B[steps , stepping] ; 

new_matrix1 [steps , stepping]  :=  B[steps , stepping] ; 

End; 

End;  mplus:=  size-1;  value2 : ®value1 ; 

For  steps  : =  1  to  mplus  do 
Begin 

matrix  multiplication A1 A, new  matrixl . 

~  new  matr ixl  , size , sizF.value2 ) ; 
step  :=  valuel  +1;  valuel  :=  valuel  +  value2; 

For  k  :=  1  to  size  do 
Begin 

For  stepping  :=  step  to  valuel  do 
Begin 

steppings  :=  stepping-step+1 ; 
new  matr ix2 [k , stepping] : =  _ 

new  matrixl [k , steppings] ; 

End;  - 

End; 

End; 

For  steps  :=1  to  size  do 
Begin 

For  stepping: =1  to  valuel  do 

S§ig  matr ix[steps , stepping]  := 
new  matr iX2 [steps , stepping] ; 

~ End; 


1  to  ni  do 
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End;  mplus : *  1  ; 

For  steps  :=1  to  size  do 

Befe?r  ix  reduction( big  matrix , mplus , size , last_rank ) ; 

mplus  T=  last  rank  +1 ; 

End;  - 

If  last  rank  =  size  then 

Writeln(’The  system  is  controllable.  ’ );Writeln; 

If  last  rank  <  size  then 

Wr iteln~(  ’ The  system  is  uncontrollable.  ’);Writeln; 
valuel : =value1 plus ; 

KEYREAD ( KEY , KEYOLD , NOT  ERASED ) ; 
repeat  ,  ~  .  . 

box  printer : got oxy( 58 . 1 5 ) ; text color (yellow) ; 
itelnf  * "CONTROL. RES* ’  ) ; 


wr 
gotoxy 
:oto 


25 


’ ); 

)  or  ( ch= 


P>  ) 


); 


’ ); 

CONTROLLABILITY 
The  Plant  matrix  A  is  :  ’); 


.write( ’ 

If  (ch=’F’)  or  (ch=’f’)  or  (ch=’p 
then  Begin 

If  (ch= ’F’ )  or  (ch=’f’)  then 
Begin  .  .  ,  . 

gotoxy (4 5,1 5 ):Textcolor( red) ; 

writelnC  »  PRINTING . s 

AssignC list , ’ control . RES ’ ) ; 

Rewr ite( list ) ; 

End: 

If  (cha’P’ )  or  (cha’p* )  then 
Begin  ,  , 

gotoxy (45, 1 3  )  ;Textcolor (red) ; 

writelnC  »  f’RIN'frlNG.  . . 

AssignC list , ’LST: ’ ); 

RewrTte(lis-t) ; 

End; 

Writeln( list ,  ’ 

RESULT  » ) ; 

Writeln( list ) : 

WritelnC list , 1 
writeln( list ) : 

For  steps  ;=  1  to  size  do 
Begin 

For^stepping 

e$rite(list, ’  ’ ,A1 A[steps , stepping] 

End; WritelnC list ) ;  ,  v 

End : Writeln( list ) ;Writeln(list); 

WritelnClist , ’ The  input  Matrix  B  is  :  ’); 

writelnC list ) ; 

For  steps  :=  1  to  SIZE  do 
Begin 

For^stepping  :=  1  to  ni  do 

6§rite( list,’  ’,B[steps, stepping] : 1 1 ) 
End; writelnC list ) ;  ,  , 

End; WritelnC list) ;Writeln(list); 

If  last, rank  =  size  then 

Writeln( list ,’ The  system  is  controllable. 

Wr iteln ; 

If  last  rank  <  size  then 

Writeln“( list ,’ The  system  is  uncontrollable. 
Writeln:  ,  . 

writeln(list);writeln(list); 

CloseClist ) ; 

End; 


: =  1  to  size  do 


11); 


) 


); 


Until  Ch  in 
Assign(SvsFi _ _ r  _ 
ExecuteCSvsFile ) ; 
ad. 


C  ’  Q  ’ 
Ie,  ’ 


’  q’ li 
svs . CO 


M’  ) ; 
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Program  Observability( input , output ) ; 
label  Ijlabel  2;label  3;label  4; 

<$I  Typedef . SYS }  {program  type  and  definitions) 


type 


Aryl 


=  Array [ 1 .. 1 1 , 1 •• 1 1 ]  of  real; 


stepping , steps . step , tempi , temp2 , 
add  no , value2 , last  rank  :  integer; 

matrix  “  :  aryls; 

matrix  matrix  :  aryl ; 

,  list  ~  „  :  text; 

{$1  Boxuser.inc) 

($1  Control. inc)  ,  ^  . 

{$1  Ut-mod01 . inc  >  {utility  input  routins) 

Begin 

ClrScr ;  Textcolor (yellow) ;  .  j 

Writeln(’The  Plant  matrix  A  is:  ’);writeln; 
For  steps  :=  1  to  size  do 
Begin 

For  stepping  :=  1  to  size  do 

6$rite( ’  ’ , A1 A[steps , stepping] : 1 1 ) ; 

End; Wr iteln ; 

End;Writeln;writeln;  „  J  A  , 

WritelnC’The  output  Matrix  C  is  :  ’ );writeln; 

For  stepping  :*  1  to  no  do 
begin 

for  steps :=1  to  size  do 

130  rH  n 

Write( ’  C[stepping, steps] : 1 1 ) ; 

end;writeln; 
end: 

wr iteln ; wr iteln; 

add  no:»no;  value2  :»1; 

For~steps:»  1  to  no  do 
Begin 

For  stepping: =1  to  size  do 
Begin  _  .  , 

matrix  matrix[steps „steppingj  := 


matrix[steps 

End; 

End; 


epping] 


4:matrix  reduction(matr ix  matrix, add  no, 
—  ,  size.lSst  rank); 

{calculate  the  rank  of  the  mat 


rix) 


If  last  rank  <  size  then  GoTo  2:  . 

Writeln(’The  system  is  observable  with  index  ’ 

KEYREAD( KEY , KEYOLD , NOT_ERASED^ ; 

GoTo  1 ;  m 

2: If  valye2  <  size  then  GoTo  3; 


2: If  value2  <  size  then  Goto  3; 

Writeln, (’The  system  is  unobservable.  ’); 
KEYREAD(KEY,KEY0LD,NOT  ERASED); 

WritelnjGoTo  1 : 

3:value2  :=  value2+1 ; ,  j  ...  ^ 

matrix  mul tipi i cat ion ( mat r ix , A1 A , matrix.no , 
—  size . size  ) ; 

{multiply  the  A  and  C  matrices  ) 

For  steps  :=  1  to  no  do 
Begin 

step:=  last  rank  +  steps; 
for  stepping: =1  to  size  do 
Begin 
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program  Luenber^_observer ( input , output ) ; 

( $i  Ut-mod01 . INC} 

($1  Ut-mod.02  .  inc ) 

label  940;label  960;label  22;label  28;  label  950; 


Type 


aryl 

ary2 

ary3 

ary4 

ary6 


array 

array 

array 

array 

array 


1  . . 1 0]  of  real ; 
1  . .30. 1  . .30]  of 


.1  .  .30 
,1  .  .  1  1 
1  .  .  1  1 


. .30]  of 
of  real ; 
of  real; 
of  intege 


real ; 


rrl  .rim ,000,0000 

i,NR1,l  , mm , nrm, nrp , ixx , j xx , s ,  one 
nrn , nr , r . rp , k  , t , o , umran , i i , ] j , 
code ,  vertpos ,  honzpos  ,  poscounter 
h ,  a.i  ,e 

coeff , coef , desired  feedback 
f 

beta,x 

?hi  ,  u 
is-fc 

strg, exponent 
change 

specification 

Realpar tvalue , imaginarypartvalue 
temp , inputtype 

{$1  Ut-mod03 . inc } 

($1  Luenberg. inc } 

($1  Pole. inc} 

<|l  Rootf ind. inc } 

($1  Boxuser.inc} 

Begin 


real ; 


:  integer ; 

:  aryl ; 

:  ary4 ; 

:  aryl s ; 

:  ary3 ; 

:  ary2 ; 
:text;  _  _ 

:  str ing[2] ; 
rboolean ; _ 

:  string[5] ; 
:  ary3s ; 

:  char ; 


gin 

ClrScr;  luen := true ; one := 1 ; 
for  i:=1  to  size  do 
for_li=1  to  1  do 
E [i 1 : =B  T i , 1 ] ; 
gotoxy C l ,22) ; 

invvideo(  ’ Press  <ESC>  to  change  it!, 
gotoxy^ 1 , 23  } ; 

invvideo( ’ Then  type  your  input  with  <ENTER>  key 
gotoxy(l.l);  Textcolor ( 1 ightblue) ; 
writelnC ’  ***  Luenberger  Observer  Design 

Parameters  *»#>); 

TextCol^r (yellow) ; 

TextColor (yellow) ; 

msg( ’ Input  degree  of  observer  (  10  max)’  ,1,5); 
Repeat 

input ( ’N’ , ’  ’ ,40, 5, 3, true, FI ,F10); 


input ( ’ N ’ , ’  ’ ,40, 5, 3, true, 

val ( answer , r , code ) ; 
if  (r  >  10}  and  X  r  <  1  ) 
til  (r  <=  1 0 )  and  (r  >  0); 


until  (r 
rp : =r+1 ; 


then  beep( 900 , 350 ) ; 


msg( ’ Input  the  Desired  Feedback  Coefficients  in 
,  Factored  <F>  Form  ’,1,77; 
msg( ’  or  Coefficient  <C>  Form  ’,1,8); 

@P0  ^ 

Input ( ’ A ’ ,  ’ C ’  ,64,7.2. true, FI  ,F10)  ; 
temp : =copy( answer ,1,1); 
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if  not  (temp  in  [’F’.’C’])  then  beep( 900 , 350  ) ; 
until  temp  in  [’F’.’C’J; 
inputtype : =temp ; 

Case  inputtype  of 
’ F ’ :begin 

if  change  then 
for  i:=1  to  size  do 

b6ftr ( re alp art value [i] : 8 :2.,  Filvar [2*i+9] ) ; 
strUmaginarypartvalue  ti  J:8:  2  ,  [2,1  +  1  0]  } . 

end  * 

input  Factor ed( ’POLES’ , size , Real  Par tvalue . 

—  Imaginarypartvalue); 

end; 

’  C ’ :begin 

if  change  then 
for  i:=  1  to  size-1  do 
n 

str (Desired  feedback [size-1 ^i] :8 : 2, 

-  Filvar [size+22-i] ) ; 

end  * 

input_coef ( ’ POLES ’ , size-1 , Desired_f eedback ) ; 

end ; Cl rScr : Wr i teln : gotoxy (1 >  22 ) ;  . 

invvideo( ’ Press  <ESC>  to  change  it!,  ); 

?nvvicLeo(  ^Then  type  your  input  with  <  ENTER  >  key  ’); 
gotoxy (1.1);  TextColor ( 1 ightblue ) ; 

writeln( ’  ***  Luenberger  Observer  Design 

Input  Parameters  ***’); 

textcolor (yellow) ;  , 

wr iteln( ’=i================*=*====================’); 

textcolor ( green ) ;  ,  ^  J  ,  .  , 

msg(’ Input  observer  characteristic  polynomial 

&  Factored  (F)  Form  ’,1,5):  . 

msg( ’  or  Coefficient  (C)  Form  *,1,6); 

repeat 

input ( ’A’ , ’C’ ,65, 5, 2, true, FI ,F10) ; 

ifmnot  ?tempa’inWt^i'  ’  !  ’  C  *  ]  )  then  beep(  900 , 350  ) ; 
until  temp  in  [’F’.’C’j; 
if  temp  =  ’C’  then  goto  950; 


if  change  then 
for  i:=1  to  r  do 

begistr  (  realpar  tvalue  [i]  :  8  :2  .Filvar  [2*i+9l)j  . 

str  ( imaginaryp art value [i] :  8  :  2  , Filvar [2* i+1 0] ); 

end  • 

input  Factored( ’ POLES ’ , r , Real  Par tvalue , 

—  ImaginaryPartvalue); 

Polynomial  of  root s( r , Realpar tvalue , 

“  -  Imaginarypartvalue , coef) ;  GoTo  960; 

950: if  change  then 
for  i : =  1  tor  do 

beglstr ( coef [r-i] : 8 : 2 , Fi lvar [r +22 -i ] ) ; 
end; 

input_coef f (  ’ POLES ’  , r , coef  ) ; 

root  finder(r ,coef, realpar tvalue , 

—  imaginarypartvalue , one ) ; 


i 


*i 
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Writelnt’The  observer  eigenvalues  are  : 

WritelnC’  REAL  PART  IMAGINARY  PART ’ ) ; 

for  i:=  1  to  r  do 

Begin 

Write( ’  ’ , realpar tvalue [il : 1 0 , ’  +  * 

imaginarypartvalue [i J :  1  0 ,  3  ’);  Writeln; 


-- — — o r'  w  * 

End: 

Writeln: Writeln; 


vTi  x  ucxu.wri  ucj.ii; 

Writeln( ’ The  Observer  characteristic  polynomial 
_  coefficints  in  ascending  powers  of  S’); 
wr*  item : 

for  i : *  1  to  rp  do 
Begin 

WriteCcoef [i] : 1 0 , ’ 

End;  Wr  lteln : Wr itein : 

960 : KEYREADC KEY , KEYOLD , NOT  ERASED) ; ClrScr ; 


—  —  ■  —  -  '  —  -  4.  1  •».  -l—i  «  41 

for  i:=  1  to  30  do 
Begin 

for  1:=  1  to  30  do 

End; 

End; 

for  i : =  1  to  r  do 

Begt!]:=  0.0, 

Rfi=.i.0, 

for  i  : =  1  to  r  do 
Begin 

for  1 : =  1  to  r  do 

Bem.l]:=  0.0, 

End; 

?%i,l]  :=  -COEF [rp-i 1 ; 

i::  i  *  r  then  goto  28; 

asffea}*15  " 

for  i:=1  to  20  do 
begin. 


BEt1Ci?:=6.0; 


End; 

nr  :=  size  *  r; 
for  i:=  1  to  nr  do 
Begin  _ 

BETA[i]  :=  0.0; 

End; 

nrp  : =  nr  +  1 ; 
nrn  :=  nr  +size: 
for  i  : *  1  to  size  do 
Begin  _ 

BETA[nr+i]  :=  desired  fecdback[i] ; 
End;  - 

for  i  :=  1  to  r  do 
Begin 

ii  :  =  size*( i  —  1  ) ; 
for  1:=  1  to  r  do 
Begin 

nj  :  =  size  *  (1  —  1  ) ; 
for  k:=  1  to  size  do 
Begin 

PHlCii+k, J j+k]  :=  -F[i,l]; 

End; 

End; 

End; 

for  i i : =  1  to  r  do 


.  .V.  -A. .  V.  *»■  •  A.  a.  .  V V  A  kJV  ~  m 
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iffjii-l )  •  size; 
for  1:=  1  to  size  do 
Begin 

for  k:=  1  to  size  do 

Bef6l[i+1 , i+k]  :=  PHlCi+1 ,i+k]+  A1 A[k,l] ; 
End; 

End; 

End; 

for  ii:=  1  to  r  do 
Begin  ...... 

l  :  =  size  *  (n-1  ); 
for  1:=  1  to  size  do 
Begin,.  _  _  _ 

PHI [nr+1 , i+1]  :=  H[ii] ; 

End; 

End; 

for  i:=  1  to  size  do 
Begin 

for  1 : =  1  to  no  do 
Begin,.  _  _ 

PHI [nr+i , nr +1 ]  :=  C[l,i]; 

End ; 

End; 

nrm  : =  nr  +no ; 
for  ii:=  1  to  r  do 
Begin 

i : =  size  *  ( ii-1  ) ; 
t:=  nrm  +  no  *(ii-1); 
for  k:=  1  to  no  do 
Begin 

for  s:=  1  to  size  do 
Beffin 

e  FHI[i+s,t+k]  :=  -C[k,s]; 

End ; 

End ; 

mm:=  r*  (size+no)  +  no; 

Boxuser ;  , 

Text Co lor ( white ) ; 

1 inear_equat ion( PHI , NRN  f MM , BETA , X ,K , U ) ; 

for  ii:=  1  to  r  do 
Begin 

i:=  size  *  (ii-1); 

AJ  [ii J  :=  0.0; 
for  o  :=  1  to  size  do 

jfii] : =AJ[ii]  +E[o]  »X[i+o]; 

End; 

End; 

nr  1  : =  nr  +  1  ; 

ClrScr;Writeln;Writeln; text color 
Writeln(’The  F  Matrix  is  :  ’);Wr 

for  i:=  1  to  r  do 
Begin 

for  o:=1  to  r  do 
Begin  „  ^ 

Wr ite(  ’  ’  ,F[i , o] : 1 1  ) ; 

End; Writeln ; 

End; 

KEY6EAD( KEY , KEYOLD  f  NOT  ERASED);  Cl r Scr : Wr i te In : 
textcolor (yellow) ;WritSln( ’The  G1  Matrix  is  :  ’ 

Writeln; 

for  i i : =  1  to  r  do 


el  low) ; 


); 


FILE:  LUENBERG . PAS 


Program  Listing 


Page  5 


,AJ[i] : 1 1  ); 


Begin 

i:=  no  #(ii-1)  +  nrm; 
for  o:=  1  to  no  do 
Begin  /  r 

Wr ite( ’  ’ , X [o+i] : 1 1  ) ; 

End; Wr iteln ; 

End; write In ; writ eln : 

Wri-fceln  (’The  G2  Matrix  is  :  ’);Writeln; 
for  i  :=  1  to  r  do 
Begin 

Writeln( 

End; 

KEY&EAD ( KEY , KEYOLD , NOT  ERASED ) : 

ClrScr ; t ext col or ( yell oW) ;Wr iteln; 

Writeln  (’The  output  feedback  coefficients  are 
(  Ascending  powers  of  S  )  :’);Writeln; 
for  o:=  nrl  to  nrm  do 
Begin  ,  r  _ 

wr ite(  ’  ’  ,  X [o] : 1 1  )  ; 

End; Writeln; wr iteln ; 

WritelnC’The  compensator  feedback  coefficients  are 
(ascending  powers  of  S  )  :’); 
writeln;for  i:=  i  to  r  do 
Begin 
Write( ’ 

End;  ,  . 

KEY6EAD( KEY , KEYOLD , NOT_ERASED ) ; 


,H[i] : 1 1 ); 


Repeat 


S@  2LX 

ox  printer ; text col or (yellow) ;gotoxy( 58,15); 
write( ’ "LUENBERG. RES"  ’); 


: wr ite(  ’ 

)  ; 


) 


); 


) 


gotoxy( 1 ,25 
f2ad?«>d  ah 

if  (ch=’f,’)or  (cha’p’)  or  (ch=’F’)  or  (ch=’f’)  then 
Begin 

Tf  ( ch= ’ F ’ )  or  ( ch= ’ f ’ )  then 
Begin  ,  v  .  , . 

gotoxvf  45,15); Text col or ( red) ; 

write(  ;  PRINTING . „  . 

Assign( list , ’ luenberg.RES ’ ) ; 

Rewr ite( list ) ; 

End : 

if  (ch=’P’)  or  (ch=’p’)  then 
Begin 

gotoxy ( 45 , 1  5 ) ;  text  col  or  (  red ) ; 

write( ) PRINTING. . . 

Assign( list , ’LST : ’ ) ; 

Rewr ite(list ) ; 

End; 

Wri-£eln(  list ,  ’LUENBERGER  OBSERVER  RESULT 
For  i:=1  to  2  do  writeln( list ) ; 

Wrlteln( list ,’ The  plant  matrix  A 
Writelni list ) ; 
for  i : = 1  to  size  do 
Begin 

for  1 : = 1  to  size  do 
Begin 

Write(list  ’  ’  A1 A [ i , 1 ] : 1 1 ) ; 

End; Writeln (list ) ; 

End;Writeln( list ) ; 

Writelm list .’ The  input  matrix  B 
Writelni list ) : 
for  i:=1  to  size  do 
Begin 

for  1 ; = 1  to  1  do 
Begin 

Write( list , 


); 


is 


) 


is 


) 


’  ,  B [i , 1] : 1 1  ) ; 


1 1  0 


* 


5 

v) 


..'V 

A 


.  '  < 

a 


S  t 

V; 


I? 


& 


f 


f. 
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C  is: ’  ) ; 


End: Writ eln( list ) ; 

End: WritelnClist ) ; 

WritelnClist The  output  Matrix 
WritelnC list ) ; 
for  i : =  1  to  no  do 
Begin 

for  1:=1  to  size  do 
Begin  ,  _ 

Write(list. ’  ’  , C [ i , 1] : 1 1  ) ; 

End :wr itelnC list ) ; 

End: Writeln( list ) ; 

Wr itelnC list The  desired  feedback  coefficients 

are  :  ’  ) ;Writeln( list ) ; 

for  i:=1  to  size  do 
Begin 

for  1:=1  to  1  do 

Begin  ,  _  _ 

Write(list.’  ’ , desired  feedback[i] 

End: WritelnC 1 i st ) ; 

End; WritelnClist) ; 


11); 


1 


Writelnf list The  observer  eigenvalues  are  : 
WritelnC list , ’REAL  PART  IMAGINARY  PART5); 

1  to  r  do 


for  i  :  = 
Begin 


WriteC list realpartvalue [i] :  1  0  ,  ’  + 

'  L i j : 1 0  ,  ’  J  *)i  WritelnC list ) ; 


imaginarypart value 
End: WritelnCl ist ) ; 

WritelnC list The  Observer  characteristic 
polynomial  coefficints  in  ascending  powers  of  S 


); 


WritelnC 
for  i :  =  i 
Begin 


list ) ; 
to  rp 


do 


Write( ljst , ’ x  , coef fi 1 : 1 1  ) : 
"  ‘ ■  itelnC list ) : 


EndjWritelnClist ) ;  wr 
WritelnClist , ’ The  F  Matrix 
r  do 


to 


for  i : =  1 
Begin 

for  o : = 1 
Begin 

WriteC list . 


is  :  5 ) ;Wr itelnC list ) ; 


to  r  do 


End: WritelnC list); 
End: WritelnClist ) ; 


,  The  G1 
to  r  do 


XJli  U.  1  VTA  i.  yui.111 

WritelnClist 
for  ii : =  1 
Begin 

i : =  no  *C ii-1  ) 
for  o:=  1  to 

BS§rite( list . ’ 
End:WritelnC li 
: WritelnClist ) ; 


, F[i , o] : 1 1 ) 

t 

Matrix  is  : 


’  )  ;WritelnC list ) ; 


+  nrm; 
no  do 


,X[o+i]  :  1 1  ) 


End; 


ist ) ; 

uu u  «  *>  i  x  oy  Aiiv  a  j.  o  o  /  f 

Writeln  (list.’Tne  G2  Matrix  is 
=  1  to  r  do 


’ );Writeln(list); 


for  i 
Begin 

WritelnC list ,  ’ 

End: WritelnC list )  ; 

Writeln  Clist.’The  output  feedback  coefficients 


,AJ[i]  :  1 1  ) ; 


for  o:=  nrl 
Begin 

WriteC list ,  ’ 


are  : ’  ) ;Writeln( list )  ; 
to  nrm  do 


ni  a.  u  i  ,  X  L o J  :  1  1  ) ; 

End:Wr itelnC list ) ; wr itelnC list); 

WritelnC list The  compensator  feedback 

coefficients  are  :’); WritelnC 1 ist ) ; 
do 


for  i:=  1  to  r 
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program  optimal , control ( input , output ) ; 
SI  Typedef.sys) 

5>I  Graphix.sys) 

SI  Kernel. sys) 

SI  Windows. sys) 

M 


($1  Ut-mod01 . INC }  {  I/O  procedures) 

{$1  Ut-mod02 . INC) 

($1  Ut-mod03 . inc > 

($1  Grapmenu . inc > 

($1  Boxuser .inc) 
label  2; label  3; 
const 

xarray  :  string[14]  -'TIME  INTERVALS : 

var 


GTNY  :  array  [1..80]  of  real: 

GTN  :  array  £  1 . . 1 0 , 1 . . 80 J  of  real; 

PSI, PI  ,D3 ,D4 ,FI , Q .gamma  :ary1s; 

D2 ,D1 . GT  : ary3s ; 

ti , i , j , 1 ,nterm,kk , code  :integer: 

y ,ymax,ymin,r .denominator .negatif ,si .result  :real ; 

Srapharray .grapharray 1  : plot array ; 

umpgraph , quit  : boolean; 

list  :text; 

ans  :char; 

{$1  Optimal. inc) 

Procedure  Pr intGraphData; 

{this  procedure  dumps  optimal  result  data  to  printer) 
Begin 


gin 

eaveGraphic : Clrscr :  Textcolor (yellow) ; 

Center  (  ’  »  »  «  f>ROGAM  6UTPUT  OPTIONS  ***',1,10,80) 
Text Co lor (green ) ; 
msg( ’ Press  <  P>  Pr 


msg( ’ Press  <P>  Print  results  to  the  printer  * , 1 , 
msg( ’  <F>  List  results  to  file  name 

"OPTIMAL . RES"  on  the  current  drive ’ , 1 , 1 3 ) ; 
msg( ’  <Q>  Quit  ’,1,14); 

repeat , 

Read( kbd, ch ) : 

If  (ch  =  ’F')  or  (ch  *  ’f’)  or  ( ch  =  ’p’) 

or  (ch  =  » ?• )  then 

begin, 

if  ( ch  *  ’ F ’ )  or  ( ch  *  ’f’)  then 
begin 

Assign( list , ’ Optimal .RES ’ ) ; 

Rewrite (lis-f; ) ; 
end 
else 
begin 

as sign (list, ’ LST : ’ ) ; 
rewrite! list ) ; 
end; 

Writeln( list ) ; 
wr ite( l i 5^  )  • 

writelnt lis£ . ’OPTIMAL  CONTROL  RESULT  ’); 
writeln(list); 

wr ite( 1 ist , ’ The  order  of  the  system  is:’); 
writeln(list,size:2); 

write( list ,’ The  number  of  time  intervals  is 

writeln(list,si:2); 

write! list , ’The  scaler  R  is:’); 

writeln(list,r:7:4); 


»  1  ,12); 
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wr ite( 1 
writeln 
writeln 
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interval 


is : ’  ) ; 


1  to ' size  do 
*  1  to  size  do 


st , ’ The  sample 
1 ist . t i : 4)7 

, list ) :  .  .  , 

writelnC list The  A  matrix  is : ’ ) ;writeln( list ) ; 
for  1 :  = 
begin 
for  j  : 
bG^in 

write( list . ’  ’ t A1 A[l , J ] : 1 1 ) ; 

end; writelnC list ) ; 
end:  writelnC list ) : 

writeln( list The  fi  matrix  is : ’ ) ; writeln( list ) ; 

for  1 : ■  1  to  size  do 

begin 

for  j : »  1  to  ni  do 
begin  ,  r 

write( list , ’  ’ , B[1 ] : 1 1  ) ; 

end; writelnC list ) ; 
end:  writelnC list ): 

writelnC list The  Q  matrix  is : ’ ) ;writeln( list ) ; 
=  1  to  size  do 


1 


to  size  do 
;t . ’  . ’ ,Q[l,j] :1 1 ); 


for  1 
begin 
for  J  : 
begin 

write(liou, 
end;writeln( list ) ; 
end;  wr iteln( list ) ; 
writeln( list f ’ The  FI  matrix  is 
for  1:*  1  to  size  do 
begin 

for  j:=  1  to  size  do 
begin  y  _  _ 

write(list  ’  ’ ,FI[l,j] :1 1 ); 

end; writelnC list ) ; 
end;  wr iteln( 1 ist )  ; 
wri-telnClist . ’The  6AMMA  matrixis: 
writelnC list ) ; 

~  1  to  size  do 


); write In (list); 


); 


for  1: 
begin 

for  J : *  1  to  ni  do 

begwrite(list . ’  ’ , GAMMA [ 1 #  J ] : 1 1 ) ; 

end;writeln( list ) ; 
end;  wr iteln( 1 ist ) ; 


writelnC list , ’MINIMIZATION  OVER  ALL  STAGES 
writelnC list ) :  v  . 

writec list , ’N  (stages)’); 

-  *  to  i  do 


); 


for  1 : 


write( list , 


writelnC list ) ; 
writeC list  > ’ 


for  1 : = 1 


writeC list ,  ’ 
writelnC list ) 


1 


to  i  do 

'ft. 

to  ti  do 


GAIN: ’ , i 
’  ); 


); 


); 


for  1  :  = 
begin 

write( list ,  ’ 
for  1:=1  to  i 
begin 

write( list .  ’ 
end; writelnC li 
end; 
end; 

until  ch  in  [’F’,’f’ 
EnterGraphic ; 
swapscreen ; 


do 


); 


ist )  ; 
’Q’ 


graphArrayl [J , 1] : 1 0  ) ; 
’q’ , ’P’ , ’p’] ; 
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close( list ) ; 
end; 

begin 

clrscr ; TextColoi 
writelnf  ’  * ' 
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clrscr ; Text Co lor ( 1 ightblue ) ; 

writeln(’  ***  Design  of  Optimal  Control 

procedure  ***’); 

Textcolor (yellow) ; 

wr  iteln(  ’  **=****==3===*=*=*****==***=**==**== 
gotoXY( i , 25 ); InvVideo( ’ Press  <ESC>  to  change 
Then  Type  your  input  with  < ENTER >  key’); 

Text Col or (green) ; 

Msg( ’ Input  number  of  time  intervals  for  SUM 
procedure?  (  MAX  99  )  ’,1.4); 
input ( >N’ , ’50’ ,65.4,6, true , FI  ,F10) ; 
val ( answer , ti , code ) ; 

Msg ( ’What  is  your  sample  interval ?’, 1 , 6 ) ; 


V  CLM  V  f  U  M  f  W  /  / 

Msg( ’What  is  your  sample  interval?  ’ , 
input  ( ’N’ , ’0.1 ’ ,35, 6, 6, true, FI ,F10); 
val ( answer , si . code ) : 

Msg( ’What  is  the  value  of  scalar  R  ? 
Input ( ’N’ , ’0.0’ ,35, 8, 6, true, FI ,F10); 
val ( answer , r , code ) ; 


1,6); 

’,1,8); 


cost 


COST-terminal+traj  ectory 
COST* terminal +fuel 


Msg( ’ COST*terminal+fue 
COST* terminal 
msg(  ’  ’ , 1 , 1 3 ) ; textcolo 

msg( ’Where  ,1,14);  t 


msg 

msg 

msg 

msg 

msg 

msg 

msg 

msg 

msg 

msg 

msg 

msg 


ory  or 
<  0> ’ , 1 , 1 1  ) ; 
or 

<1 > ’ , 1 , 12) ; 


rminal  7  <i>’ ,1 ,12); 

); textcolor (yellow): 

,1,14);  textcolor ( lightmagenta) ; 

Terminal  *  1/2  X  (N)  Q  X(N)  ; ' 1 ’ 1 1 ) j 

N-  IT  1 ^ ^  To  J • 

ectory  *  1/2  X  (k)  Q  X(k)  f  ’  jl^9); 

’  ’,  1  ’,  2?  j ; 

N- IT  ’1  22 ) • 

Fuel  *  1/2  U  (k)  R  U  (k)/^^); 


TraJ  ectory 


Fuel 


Input ( ’N’ , ’0’ ,65, 10, 2. true, FI ,F10); 
val (answer , n term, code ); clrscr ; 
writelni ’ enter  the  element  of  Q  matrix: 
for  i:*1  to  size  do 
begin 

for  J:=1  to  size  do 
begin 


§t  i  ,  J]  :=0.0; 

writef ’Q(’):write(i);write( ’ , ’ ); write ( j ); 
write(’J=  ’ ) ; readln( Q[i , j ] ) ; 
end;writeln; 
end; 

Repeat 

ClrScr ;  Writeln; 

Writeln(’The  Q  Matrix  is  :  ’);  writeln; 

for  1  :*1  to  size  do 

Begin 

for  1  :=  1  to  size  do 

Begin  _  _ 

Write( ’  ’ ,  Q[i , j ] : 1 1 ) ; 

End;  Writeln; 

End*  wr i tcln 1 

Wri-fce(’Do  you  want  to  change  any  element  of 
the  Matrix  ?  (  Y  /  N  )  ’); 

Read( Kbd, Ans ) ;  writeln; 

(allows  user  to  change  entered  data  ) 


’  ) ; wr ite( j  ) ; 


);  writeln; 


Q[i,d] :11  ); 
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if  (  Ans  *  »Y’ )  or  (  , 
Begin 

write(  ’ Input  the  ro’ 
write(  ’ Input  the  co 
readlm 1 ) : wr iteln ; 
vritefW  5  ,i.  ’  ,  '  ,d  , 
„  Q[i,d J : “result ; 

End; 

Until  Ans  in  [’N’.’n’]; 
textcolor ( white ) ; 


PAS  Program  Listing 
=  ’Y’)  or  (  Ans  =  ’y’)  then 


Input  the  row  to  change  :  ’ ) ;  read 

Input  the  column  to  change  :  ’); 

d);writeln; 

QC.ij’.’.d.’)®  ’) ; readln( result ) ; 
“result; 


Paige 


eadln( i  ) ; 


Boxuser ; 

FI  and  GAMMA( SI , FI , GAMMA ) : 

(  c311  procedure  to  calculate  fi  and 
m  ,  ,  , ,  x  gamma  matrices  ) 

TextColor (yellow) ;  clrscr; 
writelni’Tne  FI  matrix  is  :  ’); 
for  i : = 1  to  size  do 
begin 

for  d : =1  to  size  do 
begin  ,  _ 

write( ’  ’ ,FI [i ,d ] : 1 1 ) J 

end;writeln; 
end: wr iteln ; writ el n ; 
writelni’The  gamma  matrix  is:  ’); 
for  i:=1  to  size  do 
begin 

for  d : = 1  to  ni  do 
begin  ,  r 

write( ’  ’ ,GAMMA[i,d] :1 1 ); 

end;writeln; 
end; wr iteln; wr iteln ; 
keyread(key .keyold.not  erased); 

Boxuser :  — 

for  i:=>1  to  size  do 
begin  _ 


§1?i] : =0 . 0 ; 
D2[i1 : =0 . 0 ; 
for  d ’ * 1  to  si 

b<Wi,. a 

|tfi;  s:8tf 


ze  do 


«*  0 . 0  ; 

D4[i;:j]  :=0.0;  _ 

PI  U  Jj  :  *Qti  *d  ]  J 
end; 
end; 

v : *0 . 0 ;ymax : -0 . 0 ; ymin : *0 . 0 ; 

for  kk:=1  to  TI  do 

begin 

denominator : *0 . 0 ; 
for  i:*l  to  size  do 
begin 

for^d:*1  to  size  do 

S§1?i] : *D1 [i]  +  GAMMA [ d  *  1 ]  *  PI  Cd  . i U ; 
end; 
end; 

for  i:  =  1  to  size  do 
begin 

for  dJ*!  to  size  do 

S§2?i] :-D2[i]  +  D 1 C d ]  *  FlCd.i]; 
end; 

denominator : “denominator  +  D1 [i]  *  GAMMA [ i , 1 ] ; 
end; 

denominator : “denominator +  R; 
negatif : *-1 . 0 : 
for^i:=1  to  size  do 

§T?i]:=  negatif  *  D2[i]  /  denominator; 


*D2 [ i ]  +  D1 Cd]  *  FlCd .1] ; 
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GTNri.KK] :-GT[I] ; 

DILI J : =0 . 0  ; 

D2[i] :=0.0; 
end; 

for  i:=1  to  size  do 
begin 

for  j  :  =  1  to  size  do 
begin 

PSI[i,j] :=FI[i, j]  +  GAMMA [ i , 1 ]  *  GT[J]; 
end; 
end; 

for  i:=1  to  size  do 
begin 

for  j:=1  to  size  do 
begin 

for  1:«1  to  size  do 

e§3?i,d] :«D3[i.J]  +  PSI[l,i]  *  PI [1 , j ] ; 
end; 
end; 
end; 

for  i:=1  to  size  do 
begin 

for  j:=1  to  size  do 
begin 

for  1 : = 1  to  size  do 

ef4?i.d] :=D4[i, j]  +D3[i,l]  *  PSI[l,j]; 
end; 
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PSI[1 , j] ; 


if„nterin  <=  0  then  goto  2; 

5  Sc?? 

3:D4[t,J]=.§Ti1]; 


end; 

end; 

for  i:=1  to  size  do 
begin 

for  J : = 1  to  size  do 

be§3?i ,  J] :=0.0; 
end; 
end; 
end; 

for  i:=1  to  size  do 
begin 

for  j : *  1  to  t i  do 

e§TNY[Jl : =GTN[I , J] ; 
if  aos(y)  <  I.0e07  then  y 

else  y 

if  y  >  Ymax  then  Ymax:=y; 
if  Y  <  Ymin  then  Ymin:=Y; 
Grapharray M , 1 1  :=  j; 
gr  aphar  ray [1,2]  :=  y; 

grapharray T [j , l] : =  y; 

; 

Ymax:=  1.2  *  Ymax; 


m 


ini tgraphic ; 
selec twindow( 1 ) ; 


gotoxy ( 4 , 4 
gotoxy ( 4 , 5 
gotoxy ( 4,6 
gotoxy ( 4 , 7 
gotoxy ( 3 , 9 


write( ’ G ’ 
writet  ’ A ’ 
writet  ’  I  ’ 
write  ’ N ’ 
write( i : 2 


•.'.VAW  V.  A  ■.•.V.S  .'.V.'A  A  A  AV.  S  A  A  A  A  A'A  A  A  A  A  A 


>AAA AAA 
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drawtext( 250 ,195.1 .xarray) J  v 
Niceaxes(0, ti ,ymin,ymax, ’  5); 

Selectworld(worldndxglb) ; 

Selectwindow( windownaxglb ) : 
Drawpolygon(grapharray ,1  ,-(ti-1  ), 0,0,0); 


repeat  until  keypressed; 
quit : =false ; 

j*  gp0 

Graph  menu( • OPTIMAL  CONTROL  GAIN 

PLOT ’, dumpgraph , quit ) ; 


if  dumpgraph 
until  quit: 
leavegraphic ; 
end; 


then  printgraphdata; 


Assign( 

Execute 

end. 


vsFile, ’svs.COM’ ) 
SvsFile ) ; 
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/ ^  ^  v p  jln>  v  v  > 
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program  pole_placement ( input , output ) ; 

{comman  type  &  variable  definitions} 

) 

inc 


SI  Typedef . svs  } 
SI  Ut-mod0 1  . inc  ) 
$1  Ut-mod02 . inc  } 


label  1 00 ; label  110;label  120;label  130;label  140: 
label  150;  label  160;label  170;label  180;label  190; 
label  200;label  210; 


type 

ary6 

ary4 


=  arr 
=  arr 


ay  Cl  - -211  of 
ay  [ 1 . . 1 1 J  of 


var 

AA^PIN, PI  0 

CC , H , DEN , E , HH 
realpart , imaginarypart , real  part 


integer ; 
real ; 


: aryl s ; 
: ary4 ; 

: ary4 ; 


*  o  ,  xiucL^xuai  j  uai  u  •  i  cax  yjcxx  o  , 

imaginarv_part , realroot . imaginaryroot , 
realpart 1 , imaginarypart 1  : ar 

nn.umran, i ,  1 , ,k,l ,n2 ,n1 ,m  ,er  , 


ary3s ; 

: integer ; 

: real ; 
:char; 

: string[2] ; 
:boolean; 
:string[5] ; 
: f ile ; 

: integer ; 

: text ; 


vertpos , horizpos , pos counter , code 
gainl .test 
input2 

exponent , strg 
Change , factored 
specification 
inputf ile 

reduceorder ,msize , one 
list 

$1  Ut-mod03 , inc } 

SI  Pole. inc} 

SI  Polynom.inc) 

SI  Inverse. inc) 

SI  Rootf ind . inc } 

$1  Boxuser .inc) 

begin  (  open-loop  calculations} 

nn : =size+1 ;  Boxuser ; luen : =false ; one : = 1 ; 

CHARACTER I ST I C_EQU At I ON  f A 1  A , S I Z& , DEN ) : 

.  (call  polynom.inc} 
clrscr ; Text Col or (yellow) ; 
writeln( ’Denominator  of  Y(s)/U(s)  :’); 
vertpos : =2 ; 
for  i:=nn  downto  1  do 
begin 

0  :  =nn-i : 

Boscounter:*(J  mod  4)  +1; 

or izpos : =poscounter  *  1 4 ; 
if  poscounxer  =  1  then  vertpos :=  vertpos+2; 
if  i  <>  1  then 
begin 

gotoXY( hoc izpos -1 0 .vertpos ) ; 
writeLDENLij :7:4 ) ; 

msg(’S  +’, hor izpos , vertpos ) ;  str ( i- 1 : 2 , exponent ) ; 

msg( exponent ,horizpos+1 ,vertpos-1 ); 
end 
else 
begin 

§otoXY(horizp os-10, vertpos) ;write(DEN[i] :7: 4 ) ; 

; 

end;writeln;writeln;writeln;writeln; 

root_f inder ( si ze , den , realpart 1 , imaginarypart 1 .one); 
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poles  of  the  Y(s)/U(s>  areftE li  PART-); 
IMAGINARY  PART  ’ ) ; 
to  size  do 


writeln( ’ 
for  i :  =  i 
begin 
wr  i  (  * 

writeC  realpart 1 [i] :7:4):_write( ’ 
writelnC imaginarypar t 1 [ij :7:4) ; 
end; 

keyread(key ,keyold,not_erased) jclrscr ; 

for  i;=  1  to_size  do_ 

P10Li,size] : =B[i , 1 ] ; 

for  jj:=  2  to  size  do 
begin 

for  i:=1  to  size  do 
begin 


+j 


) 


); 


K-1 

for 


to  size  do 


C [ 1 +  CC[i] ; 


); 


*  PI  0 [ 1 , kj ; 

end; 
end; 

for  i:=1 

beg^i1:=0.0; 

for  i : = 1  to  size  do 
CC[i] :=  P10[d ,iJ  * 

end; 

for  i : = 1  to  size  do 
begin 

m :  =nn-i : 

if  CC[m]  <>  0.0  then  goto  100; 
end;  ,  . 

1  00  -.Textcolor  (yellow)  : 
writeln( ’Numerator  of  Y(s)/U(s) 
vertpos : =2 ; 
for  i : =  m  downto  1  do 
begin 

-l  *  —  jjj  —  ^  • 

poscounter : =( d  mod  4)  +1 ;horizpos : =poscounter *  1 4 ; 
if  poscounter  =  1  then  vertpos :=  vertpos+2; 
if  i  <  >  1  then 

t>6gotoXY(  hor  izpos-1  0  ,  vertpos  ) ;write( CC[i] : 7 : 4 ) ; 

msg(’S  +  ’ .horizpos .vertpos  ) ;  str( i-1 : 2 , exponent ) ; 

msg( exponent , hor izpos+1 ,vertpos-1 ); 
end 
else 
bo^in 

gotoXY( hor izpos-1 0 .vertpos ) ; wr i te(  cc [ i] : 7 : 4 ) ; 
end ; 

end ; wr iteln ;writeln ;wr iteln ;wr iteln ; 
msize : =m- 1 ; 


root_finder(msize , CC , real root , imaginary root , one ) ; 

zeros  of  the  Y<s)/U(s)  are:RliL  PART 


IMAGINARY  PART  ’  )  ; 
to  msize  do 


); 


write 
for 
begin 
wr  1 16 ( * 

writeC  real root [i] :7:4):write( ’ 
writelnC imaginary root [ i ] : 7 : 4 ) ; 


+3 


); 


); 
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end; 

keyread( key , keyold , not_er ased ) ; clr scr ; 
m: =m- 1 ; 

clrscr ; text col or (green ) ; highvideo ; 

msg( ’ Input  the  desired  closed-loop  characteristic 
equation  ’1,6); 

msg( ’ Factored  (F)  form  or  Coefficient  (C) 
form  ?’ ,1 ,7); 

repeat  read(kbd, input2 ) 

until  input2  in  [’F’.’f’.’C’.’c’]: 

if  finput2  =  ’F’)  or  (input2=’f^)  then 

begin 

if  change  then 

for  j : = 1  to  size  do 

begin 

strfreal  par t [j ] : 1 0 : 2 , f i Ivar [2 *j +9l) ; 
str ( imaginary_part [j  J  :  1  0  :  2  , filvar [2  *  j  +1  0] ); 
end; 

input  factored( ’ POLES ’ , size , realpart , 

imaginarypar t ) ; 

goto  120; 
end; 

if  (input2=’C’)  or  (input2=’c’)  then 
clrscr ;m:=size+1 ; 
if  change  then 
for  j : =m  downto  1  do 

^eftr (E[j ] : 1 0 :2 .Filvar [size+22-j ] ) ; 
end; umr an : = 1 : 

input_coef f ( 5  POLES ’ , size , e ) ; 

root  finder ( size , E , r eal_par t , imaginary_part , one ) ; 
clr  sUr * 

write(?The  roots  of  desired  closed-loop 
characteristic’); 
writeln( ’  polynomial  are:  ’ ) : 
write?  ’  REAL  f’ART  ’  ) ; 

writeln  ’  IMAGINARY  PART  ’); 

for  i:=1  to  size  do 
begin 

write( ’  _  _  .  .  . 

write( real  part [i] : 7 : 4 1 ; _wr ite( ’  +3  ’) 

wr  iteln(  imctginary_par  t  [i  J  :  7  :  4  ) ; 
end; 

keyreadf key .keyold, not  erased);clrscr; 
goto  180; 


120:for  i:=1  to  size  do 
begin 

for  j:=1  to  size  do 

beSi¥l,d]:=a.0: 

end; 
end; 
i  •  =  0  • 

1 60: i : = i+1 ;  „  n 


to  170; 

i];  3:  =  1+” 


if  imaginary  par t [ i 1 „ < > 0 . 0  then  goto  150; 
AAT i . il : =  r  eal  part [i] ; rgoto  170; 

1 50 : AAii , il : -real  part[i);n  J:=i+1 
AA[i  ,  .1  J  :  =- imaginary  part[ij; 

AA[j  ,  i  J : =imaginary_Jart [i] ; 
i  '-=.11  ,  AA[ i  ,  i  J  :  =r eal  part[ij; 

170:if  (i-size)  <  0  theTT  goto  160; 

CHARACTERISTIC  EQUAT ION ( AA , SIZE , E ) ; 


FILE:  POLE. PAS  Program  Listing 

1 80 : f or  i:=1  to  size  do 

De§ti]:=  E [ i ]  -  DEN[i] ; 
end; 

for  i:=1  to  size  do 
begin,. 

CCC [ i ] : =C [ 1 ,  i]  ; 
end; 

INVERSE_F IND_MATR I X ( PI  0 , CCC , SIZE , PIN , CCC ,ER ) ; 

for  i:=1  to  size  do 

be§H?i] : =0 . 0 ; 

for  j : = 1  to  size  do 

e§H?i]:=  HH [ i ]  +  PIN[j,i]  *  H[j]; 
end; 
end; 

for  i:  =  1  to  size  do 
begin 

for  j:  =  1  to  size  do 

efA?i,3]:=  A1 A [ i , 3 ]  -  B[i,1]  *  HH[j]; 
end; 
end; 

CHARACTERISTIC_EQUATION( AA , SIZE , E ) ; 

if  CC[1]=0.0  then 
begin 

gainl  :  =  1  -  0 ;  goto  210; 
end 
else 

gainl :  =  E[1 ]  /  CC[1  ]  ; 

210:if  gainl  =0.0  then  gainl  :=1.0; 
textcolor (yellow) ; 
for  i:=1  to  size  do 

e@H?i]:=  HH[i]  /gainl; 
end; 

140: for  i:=1  to  size  do 
beginrjn 
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H[il;=H[i] /gainl : 

end;if  H[sizej:=0.0  then  reduceorder : =reduceorder-1 ; 
clrscr ;Writeln( ’ Numerator  of  the  Heq(s)  is  :’); 
vertpos : =2 ; 

for  i:=  size  downto  1  do 
begin 

f : =  siz©  -i • 

poscounter :  =  ( j  mod  4)  +1  ; hor izpos : =poscounter *  1 4 ; 
if  poscounter  =  1  then  vertpos :=  vertpos+2; 
if  i  <  >  1  then 

begin  „  ,  _  _ 

gotoXY ( hor izpos-1 0 , vertpos ) ; wr i te ( H [ i 1 : 7 : 4 ) ; 
msg(’S  hor izpos , vertpos ) ;  s tr ( i - T : 2 , exponent  )  ; 

msg( exponent , hor izpos+1 ,vertpos-1 ); 
end 
else 
to©fi!in 

gotoXY (horizpos-10, vertpos) ;write(H[i] : 7 : 4 ) ; 
end ; 

end;writeln;writeln;writeln; 
reduceorder : =si ze- 1 ; 

root_f inder ( reduceorder ,H, realp art, 
imaginarypar t , one ) ; 

writeln(’The  roots  of  the  Heq(s)  are  :’); 
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write(  ’  x  K-fcJAli  Jr’AKT  '  )  ", 

writeinf ’  IMAGINARY  PART  ’); 

for  i : = 1  to  reduceorder  do 
begin  ,  . 

wr ite( ’  _  _  „  ,  ) ;  . 

wr ite( realpart [i] :7:4) ;  write( ’  +j 

writeln( imaginarypar t [l ] :  7  :  4  ) ; 
end; 

keyr ead( key , keyold , not  erased);  clrscr; 
n2 : =NN- i :  n 

190:if  H[n2]  <>  0.0  then  goto  200; 
n2:=n2-1;  goto  190; 

200 : nl : =  n2- 1 :  ,  . 

TextColortyellow) ;  gotoXY(1,2); 
writelnC’Tne  feedback  coefficients  [  k  ]  are  : 
writeln;  for  i:=1  to  size  do 
b  G/Ri  n 

write(  ’  ’ ) ; wr ite( HH [i] : 7 : 4  ) ; 

end:wr iteln; writeln ; 
wrixe(’The  gain  K  ]  is  :’); 
writeln(gain1 : 7 : 4 ) ; wr it eln ; 

keyread( key , keyold , not_er ased ) ; 

R  G  ID  G  3.  "t 

Box  printer ; text col or (yellow) ;gotoxy( 58,15); 
write(  ’  "POLE. RES"  M; 
gotoxy( 1 . 251 ; wr ite( ’ 

§otoxy(49, 17 ) ; 

Read( Kbd , ch ) ; 

If  (ch=’f”)  or  (ch=’p*)  or  (ch=’F’)  or  (ch=’f’) 
then  ,  Begin v 

If  ( ch= ’ F ’ )  or  ( ch= ’ f ’ )  then 
Begin  ,  . 

gotoxv(45, 1 5) ; textcolor ( r ed ) ; 

write(  *  PRINTING . s  ’); 

Assign ( list pole . res ’ ) ; 

{print  pole  nlacement  output  ) 

Rewrite( list ) ; { to  file  on  the  current  drive) 
End: 

If  (ch=’P’)  or  (ch=’p’)  then 
Begin  ,  .  . 

gotoxy(45,1 3) ; textcolor (red) ; 

write( ' PRINTING. .  ’); 

Assign( 1 ist , ’ LST : ’ ) ;  , 

{print  pole  placement  result  to  the  printer) 

Rewrite( list ) ; 

WrilelnC list POLE  PLACEMENT  RESULT  ’); 
Writelnt list ) :Writeln( list ) ;  . 

Writeln( list . 5  The  Plant  matrix  A  is  :  ’); 

writeln( list ) ; 

For  i  :=  1  to  size  do 
Begin 

For  j  :=  1  to  size  do 
Begin  ,  _  _ 

Write(List,’  ’ , A1 A [ i , j ] : 1 1 ) ; 

End; Writ eln ( list ) ; 

End; Writ eln( list ) ;Writeln(list); 

WritelnT list . ’ The  Input  matrix  B  is  :’); 
writeln( list ) ; 

For  i  : =  1  to  size  do 
Begin 
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ents  [  k  ]  are 


current  drive) 


For  J  : =  1  to  ni  do 
Begin 

wr ite( List . ’  ’ , B[i , j ] : 1 1 ) ; 
End;Writeln(list ) ; 
id ;Writeln( list) ;Writeln( list); 
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Writelnf list .  ’ The  Output  Matrix 
writelnf list ) ; 


wr i teln( list ) 
For  i  :=  1  to 
begin 

for  j : = 1  to 
begin 

Wr  ite( lis 
end ; writeln 
end;Writeln(L 


size 


riteflist.’  ’ , C [l , j ] : 1 1 ) ; 

; wr itelnf list ) ; 
riteln(List);Writeln(list); 

writef list ,’ Denominator  of  Y(s) 
writelnf list . ’  Descending  powers 
wr iteln( list ) ; 
for  i : =nn  downto  1  do 

hg  rr  2. n 

writeflist.’  ’ ,DEN[i] :7:4 ) : 
end; writelnf list) ;writelnflist); 
writelnf list , ’ The  poles  of  the  Y 
wr itef list , ’  REAL  PART’) 

wr itelnf list , ’  IMAGl 

for  i : = 1  to  size  do 
begin 

writef list , ’  r  _  „ 

writeflist, real parti L i J •' 
wri tp( 1 1 

wr itelnf list, imaginarypar 
end; wr itelnf list ) ; writeln ( 1 


Denominator  of  Y(s)/Ufs)  -’); 
’  Descending  powers  of  S:’); 


downto 


IMAGINARY  PART 


*(s)/U(s) 
PART  •  )  ; 


■itef list Numerator  of  Y(  s ) /U( s  )  -  ’  ) ; 
•itelnf list , ’  Descending  powers  of  S:’) 
•itelnf list ) ; 


wr  itef list Numerator  o 
writelnf list . ’  Descendi 
wr itelnf 1 ist ) ; 
for  i:=  m+1  downto  1  do 
begin  y  _ 

writeflist.’  ’,CC[i 
end: writeln ( list); write 
writelnf list The  zeros 


CC [ i ] :7:4 
r itelnf li 


s-fc ) ;  ,  „  ,  ,  s 

the  Y(s)/Ufs)  are 


wr  itef list , ’ 


REAL 


are:’); 
PART ’  ) ; 


writelnf list, ’  IMAGINARY  PART 

for  i:=1  to  msize  do 
begin 

wr  itef  list ,  ’  _  -i  „  ,  x 

writeflist, real root[i] :  7  :  4  ) ; 

writelnf list , imaginaryroot  [  i  "1 : 
end; writelnf list); writ el nf list ) ; 
writef list ,  Desired  closed-loop 
,  polynomial  ’ ) ; 
writelnf list -  Descending  power 
wr  itelnf 1 ist ) : 
for  i:=  size+1  downto  1  do 

j'l 

writeflist,’  ’,E[i]:7:4); 
end; write Inf list);writeln(list); 


itef list , ’  r  —  - 

•iteflist,realroot[i] :  7  :  4  ) ; 
itef list , ’  +1  ’ 

■itelnf list, imaginaryroot [ l 1 


7:4) 


i  u.  ,  w  1 

itef 


loop  Characteristic 


end; writeln 
writeflist. 


’The  roots  of  desired  closed-loop 


writelnf 
writef li 
writelnf 
for  i : = I 
begin 
writef 
writef 
writef 
wr  itel 
end ; wr i t 


st.  The  roots  oi  desire 
characteristic’  ); 
list,’  polynomial  are: 

list,’  IMAGINARY 

to  size  do 


iUal 

PART 


PART 
’  )  ; 


liSt,’  r  —  . 

list, real  part [i] : 7  :  4  )  ; 

nf 1 ist , imaginary  partfi]:7: 
elnflist  )  ;  writ  el  FTC  list)  ; 


/I-.-;-.--,-  -•  •- 
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Write! list ,’ Numerator  of  the  Heq(s 

writelni list . ’  Descending  powers  o 

wr  iteln( list )  ; 

for  i : =  size  downto  1  do 

begin 

write! list . *  ’,H[il:7:4); 

end: writelnC list ) ;writeln(iist); 
writelni list , ’The  roots  of  the  Heq( 
writeClist,’  REAL  PA 

writelnC list, ’  IMAGINARY  PAR 

for  i:=1  to  reduceorder  do 
begin 

write! list , ’ 

writeClist , realpart [i] : 7 : 4 ) ; 
wr itsi list ) *  +1 

wr iteln? list , imaginarypar t [{ 1 : 7 : 4 
end:wr itelnC list ) ; writ el nil 1st  j : 
wr  i  teln(  1  ist ,  ’  The  feedback  coeffici 

ar 0  •  >  y  • 

writelni list ) ;  for‘i:=i  to  size  do 
begin 

writeClist,’  ’ ) ; wr ite( list ,HH[i] 
end; writelnC list); writelni list); 
write! list ,  The  gain  [  K  ]  is  :  ’); 

writelnC list .gainl : 7 : 4) » 
writelnC list); writelni list); 

Close( list ) ; 

End; 

Until  Ch  in  [  ’Q’  ,  ’q’  ] ; 

Assign! SvsFile , ’svs.COM’ ); 

„  .{re-execute  SVS  main  program) 

Execute! SvsFile ) ; 

End. 


Program  Listing 


Numerator  of  the  HeqCs) 
.  ’  Descending  powers  of 


size  downto 


6eq(s)  an 
L  PART’); 
PART  ’  )  ; 


list,’ 

list , realpart [i] : 7 : 4  ) ; 

list , ’  ’ j  • 

nf list , imaginarypar t [{] : 7 : 4  ) ; 

eln( list ); writelni list ) : 

list, ’The  feedback  coefficients 


/.  J 
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*  TURBO  GRAPH IX  version  1.00A  » 

*  Type  definition  module  * 

*  Copyright  (C)  1985  by  * 

*  BORLAND  international  * 

****#***««***#**#*#*»«*##«#**«»#*#««#•«##*»*«*##« 


const 


type 


MaxWor ldsGlb=4 ; 
Maxorder=9 ; 
MaxWindowsulb=  1  6 ; 
MaxPiesGlb=  1  0 : 
MaxPlotGlb=200 ; 
MaxBlocks  =10; 

Str ingSizeGlb=80 ; 
HeaderSizeGlb  =  1  0 ; 


RamScreenGlb : bool ean= true ; 

CharFi le : str ing [Str ingSizeGlb] = ’ 4x6 . f on ’ ; 
MaxProcsGlb=27 ; 

MaxErrsGlb=7 ; 

Extension: Str ing [4] = ’ . svs ’ ; 

wrkstr ing=str ing [Str ingSizeGlb] ; 
WorldType= record 

xl , y 1 ,x2 ,y2 :real ; 
end; 

WindowType= record 

xl  ,.y1  ,x2  ,y2  :  integer  ; 
header :wrkstring; 
drawn , top : boolean ; 
size : integer ; 
end: 

worlds=array  [ 1 . .MaxWor IdsGIbJ  of  WorldTy 
windows  =  ar ray  [ 1  * . MaxWindowsGlb]  of  Windo' 
PlotArray  =  array  [  1  .  .  MaJxPlotGlb  ,  1  .  .  2]  of  r< 
character=array  L1..3J  of  byte; 

Char Array=array  [32..T26]  of  character; 
PieType= record 

area: real : 
text :wrkstring; 
end; 

PieArray=array  [ 1 . .MaxEiesGlb]  of  PieType 
Backgr oundAr r ay = array _ [0 . . 7]  of  byte; 


Wor ldType ; 
of _ WindowType 
.2]  of  real; 


b ,  i  .  .2]  of 
e; 

character ; 


Backgr  oundAr  r  ay  =  ar  r  ay 


arra, 

.10, 


.  i 

.  1  0] 


ay  [0.,7 ]J 
,1.-103  of 
<  1  . . 1 0J  of 
real; 


]  of  PieType; 
of  byte; 


of  boolean; 
real ; 
integer ; 


LineStyleArray=array  [0.,7]  of  boolean; 
Ary1s=Array  .  ..10,1.. 10]  of  real; 
Ary2s=Array  .1  . .10.1  ..10J  of  integer; 
Ary3s=Array^  1  .  .10]  of  real; 

Str2  =  String  .2.  ; 

Str4  =  String .4.  ; 

Str5  =  Str ingL5  ;  _ 

Str20  =  Str ing  .20.  ; 

Str25  =  string  .25.  ; 

Str40  =  String  .40.  ; 

Str80=String  80  : 

Str 255= St ring [25^] ; 

XI WldGlb ,X2WldGlb ,Y1 WldGlb ,Y2WldGlb , 

AxGlb , AyGlb , BxGlb , ByGlb : real : 

X 1  Ref Gib, X2Ref Gib, Y1 Ref Gib ,Y2Ref Gib: integer ; 
LinestyleGlb .MaxWorldGlb , MaxWindowGlb , 
WindowNdxGlb : integer ; 

XI  Gib , X2Glb , Y1 GlbTY26lb : integer ; 

XTextulb , YTextGlb , VStepGlb : integer ; 

PieGlb , Direct Modeulb, ClippingGlb , 

AxisGlb .Hat chGlb: boo lean: 

MessageGlb , BrkGlb , Header Gib , TopGlb , 
GrafModeGlb : boolean ; 

CntGlb , Co lor Gib : byte ; 

Err Code Gib : byte ; 


FILE:  TYPEDEF.SYS  Program  Listing  Page  2 

LineStyleArrayGlb : LineStyleArray ; 

Error Proc : array  [0 . . MaxProcsGlb]  of  ^WrkString; 
ErrorCode : array, [0 .. MaxErrsGlb]  of  ~WrkString; 
PcGlb:string[40] ; 

AspectGlb : real ; 

Graf Base : integer ; 
world: worlds ; 
windowl : windows; 

CharSet :Char Array ; 

D:Arv2s; 

A1  A ,  B  ,  C  : Aryl s ; 

Len , Space ,Dr ive : Str2  ; 

Size , ni , no , Blockl , Key , Keyold : Integer ; 

No t_e rased, Finished .Exit .Insert on, FI ,F10: Boolean ; 

Ch : Char ; 

TemPlate .Answer , Previous  Answer : Str80 ; 

SvsFi le : Fi le ; 

P , Fi lvar : Array [ 1 .. 35]  of  str40;  (menu  prompts) 

worldndxglb  : integer; 

escape , retr iev , luen  :  boolean; 
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procedure  Bodeplot ; 

label  1;  {label  decleration  for  goto  statement) 
var 

Code , I , Count . Number Decades , Star t Decade , 
EndDecade  :  integer; 

Wf , Wo , Wi f DeltaW, Gain  :  Real; 

PlotArray 1 , PlotArray2 .MagPhaseArray , 

FreqArray  :  PlotArray; 

ZMagn , ZPnase , PMagn , PPhase , Phase  :  real; 

TempX,TempY  :  real; 

temp  :  char ; 

OpenLoop  :  boolea 

.1 .  J  J  » kkl  , m ,  1 ,  cnpoles  ,  sizezer os  ,  one  :  intege 

dencoef f , numcoef f , cdencoef f  :  ary4; 
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real ; 
real ; 
char  ; 
boolean ; 
integer ; 
ary4 ; 


realpar tpole , imagpar tpole , realp artzero. 
imagpartzero , crealpar tpole , cimagpar tpole :  ary3s ; 


aryl s ; 


function  Log( X : real ): real ; 

{computes  the  base-10  logarithm  of  X) 

Begin 

If  X=0  then  Log;=0  else 
Log  : =  Ln(X )/Ln( 10); 

End; 


10); 


function  Expon( Y , X : real ): real 

{computes  Y  ra 


Begin 
Exp  on 
end; 

begin 


{computes  Y  raised  to  X  power) 
=  exp(  X  *  ( ln( Y ) ) ) ; 


§lrScr:  boxuser ;  one : =  1  ; 

Characteristic  equation( A1 A , size , Dencoef f ) ; 
for  i:  =  1  to  silZe  do 
begin,.  _ 

FSI[i , size] : =B [ i , 1 ]  ; 
end; 

for  jj:=2  to  size  do 
begin 

for  i:=1  to  size  do 
begin 

J,:=size-j  J+1  ; 
klc  1  •  =  i  -f- 1  • 

PSI [i . J J : =Dencoeff [kkl ]  *  B[i,l]; 

for  l:=i  to  size  do 

begin 

PS I [i,J] : =PSI [i , J ]  +A 1  A [ i , 1 ]  *  PSI[l,kk1]; 
end; 
end; 
end; 

for  i : = 1  to  size  do 
begin  _  _ 

Numcoef f [i] : =0 . 0 ; 
for  J:=1  to  size  do 
begin 

Numcoef f[i] : =Numcoeff[i]  +  PSI[J,i]  *  C C 1 , J ] ; 
end; 
end ; 

for  i:=1  to  size  do 
begin 

m;  =si ze+1  *■" i  ■ 

if  numcoefftm]  <>  0.0  then  goto  1; 
end : 

1  : sizezeros : =m- 1  : 

Clrscr ; Text Co lor (l ightblue ) ; 

writeln( ’  ***  Boae  Plotting  Parameters  ***’); 
Text Co lor( yellow); 
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Msg(’Open  (0)  or  Closed  (C)  Loop  Plot? ’,5,5); 
repeat  , 


input ( ’A  , ’’  ,45, 5, 2, true, FI ,F10); 

{sets  flag  OpenLoop  if) 
temp  ;=  copy ( answer , 1 , 1  ) ; 

„  .  _  {user  selects  the  open) 

if  not(temp  in  [’O’.’C’J)  then  beep ( 350 , 1 50  ) ; 

_  (loop  option  for  plot  > 

until  temp  in  [’O’.’C’J: 
if  (temp  =  ’O’  )  then  OpenLoop  :=  true 


,  else  OpenLoop  :=  false; 

Msg( ’What  is  the  first  frequency  to  be 
„  ,  .plotted?’  ,5,7); 


,  plotted? ’ ,5,7;; 

Msg( ’( example :  .01,  1,  100.  etc,  )’ ,1 
Input  (  ’N’  ,  ’  ’  ,50,7,4,  true  ,  Fi  ,F1  0  W 
Val ( answer , Wo , code ) ;  {Wo  is  the  fir 


10,8); 

rst  plotted  freq) 


Msg( ’ Input  number  of  decades  do  you  want 


plotted? ’5,10); 

;( ’N’ , ’ ’ ,51 ,10, 2, true, FI ,F10); 


answer , NumberDecades , code 


root_f inder ( sizezeros , Numcoef f , real part zero , 
imagpar tzero, one): 


. imagpar tzero, one) : 

r 00 t_f inder ( size , Dencoef f , realpartpole , 
imagpartpole , one) ; 


gain:=  Numcoef f [sizezeros+1 ] ; 
for  i:=1  to  sizezeros+1  do 


begin 

Numcoef f[i] : =  Numcoef f [i]/gain; 
end; 

boxuser ; 


for  i:=1  to  maxorder  do  CDenCoeff[i]  ;=  0.0; 
for  i:=1  to  SizeZeros  +  1  do_  „ 

CDenCoeff[iJ  ;=  Numcoeff[i]  *  gain; 

for  i : = 1  to  Size+  1  do 

CDenCoeff[i]  :=  CDenCoeff[i]  +  Dencoeff [i] ; 


if  Size  >  SizeZeros  then  CNPOLES ; =Size 
{NPoles  should  always  be) 
else  CNPOLES : =SizeZeros ; 

{greater, but  to  be  safecompute  new  denominator  roots) 


root_f inder ( Cnpoles , CDenCoef f . CReal Part Pole , 
C ImagPar t Pole , one ) ; 


StartDecade  :=  trunc(Log(Wo ) ) ; 

{compute  linear  scale  to  plot  ) 
EndDecade  :=  StartDecade  +  NumberDecades; 

„  (log  numbers.  Also  figure  step) 

Wf  ;=  Wo  *  Expon( 10.0, NumberDecades ) ; 

DeltaW  :=  Expon( ( Wf /Wo ) , 0 . 0 1 25 ) ; 

Wi  ; =  Wo ; 


for  Count  :=  1  to  81  do{do  81  iterations ...  arbitrary ) 
Begin 

if  OpenLoop  then(compute  bode  numbers  if  openloop) 

{and  later  if  closed  loop) 

begin 


1  (.Nj-V 


ro.  *  ■  *  * 
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ZMagn:=1.0;  ZPhase:=0.0;  PMagn:*1.0;  PPhase:=0.0; 

for  i  :=  1  to  SizeZeros  do 
{compute  magn  and  phase  of  zeros  for  freq  step) 
begin 

ZMagn:=ZMagn  *  Sqrt(Sqr(RealPartZero[I] )+ 
Sqr(Wi-ImaflPartZeroLIJ ) ) ; 
if  RealPartZero[i J  =  0.0  then 
ZPhase : =ZPhase+pi /2 . 0  else; 
begin 

if  realpartzero[i]  >  0.0  then 

ZPhase : =ZPhase  -  pi  +arctan( ( wi-  r 

imagpartzero [i J )/( -realpartzero[i] ) ) 

else 

ZPhase : =ZPhase  +■  arctan((wi- 

imagpartzer o [i j ) / ( -realp art zero [i ] ) ) ; 

end; 

end; 

for  i  :=  1  to  Size  do 

{commute  magn  and  phase  of  poles  for  freq  step) 
begin 

PMagn:=PMagn  *  Sqrt ( Sqr (Real Part Pole [ I] )  + 
Sqr(Wi-ImagPartPoleLIJ )); 
if  Real  Par  t  Pole  1.1  J  *  0.0  then 
PPhase:=  PPhase+pi /2 . 0  else 
begin  _ 

if  realpartpole[i J  >  0.0  then 

PPhase : =PPhase  -  pi_+arctan( (wi-  „  _ 

imagpartpole[i J )/( -realpartpole[i] ) ) 

else 

PPhase := PPhase  +  arctan((wi- 

imagpartpole[i] )/ ( -realpartpole [i] ) ) ; 

end; 

end; 


PlotArrayl [Count , 1 ]  Log(Wi): 

{fill  plotting  matrix  with  magnitude  values) 
PlotArrayl [Count ,2]  : * , 20*LogCGain* 

(ZMagn/PMagn) ) ; 


PlotArray2 [Count , 1 ]: =Log(Wi ):{ fill  phase  matrix) 
PlotArray2 [Count , 2 J  :=  ( i 80/pi )*( ZPnase-PPhase ) ; 


{next  stmt  covers  freq  wrap-around) 
if  PlotArray2 [Count , 2J  >  0  then 

PlotArray2 [count , 2 J : = PlotArray2 [c 


[count , 2] -360 ; 


Wi  : =  Wi  *  DeltaW; 


{increment  freq  step) 


else 

{perform  same  steps  as  above  if  closed  loop  requested) 
begin 

ZMagn:*1 . 0 ; ZPhase : =0 . 0 ; PMagn := 1 . 0 ; PPhase : =0 . 0 ; 

for  i  :=  1  to  SizeZeros  do 

begin 

ZMagn:=ZMagn  *  Sqrt( Sqr (RealPartZero[I] )+ 
SqrTwi-ImagPartZeroLIJ ) ) ; 
if  Real PartZero [ I]  *  0.0  then 
ZPhase : =ZPhase+pi/2 . 0  else 
begin  _  _ 

if  Real par tzero[i]  >  0.0  then 
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ZPhase : =ZPhase  - 


;e:=ZPhase  -  pi_+arctan((wi- 
imagp art zero [ij )/ (-realpartzero[ij ) ) 


else 

ZPhase : =ZPhase  +  arctan((wi- 

imagpartzero[i J )/(-realpartzero[i] ) ) ; 

end; 

end; 

for  i  : =  1  to  CNpoles  do 
begin 

PMagn:  =  PMagn  *  Sqrt^Sqr^CRejilIj>^tPole[I]  )  + 


Sqr( Wi-CImagPart Pole  1 


if  CRealPart Pole [lj  =,0-0  then 
PPhase := PPhase+pi /2 . 0  else 
begin  _ 

if  crealpar tpole [i]  >  0.0  then 

PPhase := PPhase  -  pi_ +  arctanf ( wi- 


cimagpar tpole [ 

else 

PPhase := PPhase  +a 
cimagpar tpole 


crealpartpole [i] ) ) 


-crealpartpole [i]  )  )  ; 


end; 

end; 


PlotAr rav 1 [Count , 1 ]  :=  Log(Wi); 

{fill  plotting  matrix, with  magnitude  values) 
PlotArray 1 [Count , 2]  :=  20*Log(Gain  * 

r  ,  ,  (  ZMagn/PMagn ) ) ; 

PlotArray2 [Count , 1 ]: =Log(Wi) ; {fill  phase  matrix) 

PlotArray2 [Count , 2]  :=  ( 1 80/pi )*( ZPhase-PPhase ) ; 


if 


PlotAr ray2 
PlotArray2 


;t  stmt 
Count ,  2 
count ,  2 


overs  freq  wrap-around) 

>  0  then 

: = PlotAr ray 2 [count , 2] -360 ; 


Wi  : =  Wi  *  Del taW ; 
end; 
end: 

PlotBode( StartDecade , EndDecade .NumberDecades , 
,  PlotArray 1 , Plot Arr ay2 , OpenLoop ) ; 

d;  {bodeplot) 
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procedure  P lot Bode ( St art Decade , EndDecade , 

NumberDecades : Integer ; 
PlotArray 1 .Plot Array 2 : Plot Ar r 
OpenLoop:  Boolean); 


ay; 


U 


const 

MagnArray:  array[1..12]  of 

char  =  (  ’  M  ’  ,  ■*  A  ’  ,  ’  G 

PhasArray:  array[1..l2]  oi’  ’  ^  '  ’ 

char  =  ( ’ P’ .’H’ , ’A’ , ’S’ ,’E’ , ’  ’,’d’, 

FreqArray:  stringL1§]  = * ’ FR£]QUEn6y  (rad/sec) 


N  ’  ’  I  ’ 

B’  ) ; 


var  i , j , n 
ch 

xl  , x2 

Delta 

MagLabel 

PhsLabel 

DecLabel 

Titlel , 

Title2 

DumpGraph 

w 

quit 

list 


integer ; 
char  ; 
integer ; 
real : 
string  .3 
string  „4] 
string[3 


str ing[80] ; 
Boolean ; 
real ; 
Boolean ; 
text ; 


function  Log( X : real ): real ; 
Begin 


End; 


?fnx=0  then  Log:=0  else 
Log  :=  Ln( X )/Ln( 10); 


function  Expon( Y , X : real ): real ; 

{computes  Y  raised  to  X  power) 

Begin 

Expon  : =  exp(  X  *  (ln(Y))); 
end; 


Text co lor (white 


writeln 


#  *  # 


^OGR^M^U? £>UT  ’  opii 


writeTnf P> Printer  output 


ONS  *** 


wnteinr  sr>  Printer  output 

Text col or (yellow) ;  goxoxy( 20,14); 

writeln(’  Check  Your  Printer! 


Textcolor( white  ) ;  gotoxy C20’,  1  5  ) ; 
wr iteln( ’ <F>  List  to  File  name 


); 

); 


gotoxyC 20 ,16); 

writeln( ’  .on  the  current  drive 


gotoxy ( 20 ,17); 

writeln(’<Q>  Quit 
gotoxy ( 42,15);textcolor(yellow);write( 

); 


D’  . 


’  e  ’  , 


Procedure  PrintGraphData; 

(prints  numbers  to  a  file  or  printer) 

Begin 

LeaveGraphic ; Clrscr ; 
repeat 


) 


) 


) 


'BODE. 


l^fiS"  ’  )  ; 


If  (ch  =  ’F?)  or  (ch  =  ’f’)  or  ( ch  =  ’P 
( ch  =  ’ p ’ )  then 
begin 

if  ( ch  =  ’F’)  or  (ch  =  ’f’)  then 

begin 

gotoxy ( 24,15); text col or ( red ) ; 
write(  ’ PRINTING . 


)  or 


’  ); 


PLOTBODE. INC 


Program  Listing 
Bode. RES’ ) ; 


Page 


assign(list, ’Bode. RES’ ); 
rewrites  list ) ; 
end 
else 
begin 

gotoxy( 24,13); t ext col or ( red) ; 
write( » PRINTING . 

assign( list. ’ LST : ’ ) ; 
revrite( list ) ; 
end; 


Tit le 1 : =( ’ 

Phase 

Tit le2 : =( ’ - 

writeln( list , ’ 


Gain  ( db ) 


BODE  PLOT  RESULT 


writeln(list ) :writeln( list ) ; 
writeln(list,Title1 ) ; 
writeln(list.Title2); 


"  A  W  X  Ai  \  X  X  *3  L/  •  XX  Kj  X  ^  /  m 

wr  iteln( 1  1st ) ;  wr iteln( list ) ; 

for  i:=  1  to  81  do 

begin 

w  :=  expon( 1 0 . 0 , PlotArray 1 [ i , 1 J ) ; 
writeln( list  ’  ’  w:11:3,^ 

PlotAr r ay 1  Li  , 2 1 :  8 :  3  ,  ’  5, 

PlotAr r ay2 [i ,  2  J  :  7  :  3  )  ; 
if  i=  47  then 
begin 

write(list, chr (12)); 
wr  itelnf list ) : 
writelni list , Titlel  ); 
writelni list .Title2  ):  , 
writeln( list ) ;  wr itein( 1 ist ) ; 
end; 
end; 
end; 

until  ch  in  [’Q’.’q’]; 

EnterGraphic ; 

(when  finished  printing,  go  back  to  graphics  mode 

d  display  graph) 

swapscreen : 

close( list ) ; 

d; 


Def ineWindowi 3,5,1 5 , XraaxGlb-5 , YMaxGlb-1 5 ) ; 

Def ineWor ld( i ,0.0,100,100): 

Def ineWor ld( 2 , Star tDecade , 60 .EndDecade , -60 ) ; 

Def ineWor ld( 3 , Star tDecade , 0 , EndDecade , -360 ) ; 
SelectWorld( f ) : 

SelectWindow( 1 j : 

SetBackground(  0 )  ; 

SelectWor ld(  2 }  : 

SelectWindow( 2 ) ; 

DrawBor der ; 

SetLineStyle( 1  )  ; 

For  I : = 1  to  5  do  (draw  horizontal  graph  lines) 
DrawLine( Star tDecade ,-60+C20*I ) , 

EndDecade ,-60+(20*I)); 

For  J:=0  to  NumberDecades- 1  do 

(draw  vertical  logarithmic  graph  lines) 
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For  I : =  1  to  10  do 
Begin 

Delta: =StartDecade  +  (Log(I)  + 
Drawl ine( Del ta , -60, Delta, 60); 


Drawl ine( Del 
end; 
end; 

SelectWindow( 1 } ; 
For  I:-  1  to  12 
Begin 


{y-axis  titles) 


Begin 

DrawText ( 5,55+6*1,1 .MagnArray [ II ): 

DrawText ( 630 , 60+6*1 , 1 , PhasArray [ i] ) ; 
end; 

DrawText (250 ,195,1 , FreqArray );{ x-axis  title) 

For  I:=  0  to  6  do  (y-axis  scale  label) 

§tr( 60-20*1: 3, MagLabel )  ; 

DrawText ( 12.1 5+28*1 , 1 .  MagLabel ) ; 
Str(0-60*I:4,PhsLabel); 

DrawText (600,1 3+28*1 , i , PhsLabel ) ; 
end; 

For  I:=  0  to  NumberDecades  do 

(label  the  logarithmic  scale) 

Begin 

Str ( Trunc( Star tDecade )+I : 3 .DecLabel ) ; 

DrawText ( 36+( 570  div  NumberDecades)  *1, 

, 186, 1 .DecLabel ) ; 

DrawText ( 30+( 570  div  NumberDecades)  *1, 

1 90 , 1  , ’ 1 0 ’  ) ; 

SetiineStyle( 0 ) ; 

SelectWinaow( 2 ) ;  SelectWor ld( 2 ) : 

DrawPolygon( PlotArray 1  , 1  , -81  ,0,1 , 0  ) ; 

(plot  tne  magnitude) 

SelectWorld( 3 j : 

SelectWindowi 3 ) ; 

SetLineStyle( 3 ) ; 

DrawPolygon( PlotArray2 , 1 , -81 ,0,1 , 0 ) ; 

(plot  the, phase) 

copyscreen:  (save  screen  to  memory) 

repeat  until  keypressed; 

QVli'fc  Z  =  f  &lSG  J 

repeat  (call  for  graph  options  menu) 

if  OpenLoop  then 

Graph_Menu( ’ Open  Loop  Bode  Plot ’, DumpGraph , quit ) 


till 


;  SelectWor ld( 2 ) : 
tArray 1 ,1,-8 1,0, 1,0); 
lot  the  magnitude) 


6 1  S  6 

Graph  Menu( ’Closed  Loop  Bode ’, DumpGraph , quit ) ; 
If  DumpGFaph  then  Pr intGraphData ; 

(dump  numbers  if  desired) 

until  quit: 

LeaveGraphic ;  (leave  graphics  mode) 
end; 
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(*  This  program  draw  line  for  menu  box.  *} 
procedure  box; 
var  i  : integer; 
begin 

Lighvideo: Text Co lor (yellow) ;gotoxy( 1 ,  2)  ; 
write(chr( 21 8) ) ;  (draw  upper  left  corner) 

for  i  :=  1  to  77  do  (draw  upper  horizontal  line) 


en 


begin 

write(chr(  1  96) )  .*  v 
end;  write( chr ( 1 91 ) ) ; 
gotoxy(1,5);  wr ite( chr ( 1 92 ) ) 
for  i:=  2  to  78  do 
wr  ite( chr (196)); 
write(chr(217 ) ) ; 
for  i:=  3  to  4  do 
begin 

gotoxy( 1 , i ) ; wr ite( chr (179)); 

gotoxy( 79,i);write( chr (179)); 
end  * 

gotoxy ( 1 , 23 ) ; 
for  i  :=  1  to  78  do 
wr  ite( chr (196)); 
writelni  9  f ) * 

TextColor (white ) ; gotoXY (20,22): 
writelni ’Make  your  selection  ’); 
otoxy( 40 , 22 ) ;Lowvideo ;  (make  input  promt) 


(draw  vertical  lines) 


t? 


i 

i 

i 
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Procedure  Fi_and_gamma( var  Ttreal; 

var  f i : aryl s ; 

label  1 ;  var  gamma: aryls 

var 

A2  t  A3 , A  4 , A5 
i  ,  j  .  k 

test_value , step 


); 


aryl s ; 
integer ; 
real ; 


begin 

test  value := 1 . 0e-08 ; 

stepT  = 1  . 0 : 

for  i:=1  to  size  do 

begin 

for  j:=1  to  size  do 

be%:i3 

fill 


_  . _  =0.0; 

FI [i  ,  1 1  :  =  1  .0: 

A5 
end ; 
end ; 

1 :for  i:=1  to  size 
begin 

for  j : = 1  to  size 
begin 

A3  .i  ,.1 .  :  =  (T/ste 
Fl.i,;. : =FI L i , 1 
,  A2[i.j  :=A2[i,i 

end; 
end; 

for  i : = 1  to  size  do 
begin 

for  3:=1  to  size  do 

be|i?V]:=0.0! 

f5Ufi:b?2AftfM°+  A,  A  [  i  ,  k] 
end; 
end ; 

step : =step+1 . 0 ; 
for  i:=1  to  size  do 
for  j :=1  to.size  do 


step+ 1 . 0 )  * 
/  ( st ep+ 1  . 0  )  )  * 


A3[i  ,j  ]  : 


'r  j  :  =  i  to  .size  do 
if  abs( A3[i ,j ]  )  > 
then  goto  ’ ; 


for  i : = 1 
for 


to  size  __ 
r  1 : = 1  to,  ni  dc 
GAMMALi, j] : =0 . 0 ; 


do 

do 


(test_value  * 
{  initialize  } 


A3 [k  ,  j ]  ; 


abs  ( FI [ i , j ]  )  ) 


for  i:=1  to  size  do 
for  J : = 1  to  ni  do 

for  k:=1  to, size  do 

GAMMA L i , J  U  : = GAMMA [ i , j ] 

end; 


{calculate  GAMMA  matrix  x 
+  A5[i , k]  *  B[k, j ]  ; 


■A 


51 

>* 

M 


A 

y. ' 
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Procedure  Matrix_reduct ion( Var  dumy_square : Ary  1  ; 

Var  n ,m, rank: Integer  )  ; 

Label  1 42 ; Label  145;Label  235;Label  170:Label  180; 
Label  162;  Label  198;Label  200;Label  224;Label  226; 
Label  228;Label  234; 

VAR 


Aryl  ; 

Integer ; 
Real  ; 


reduction  matrix 
Jdc.Nmin, i . j , j j  (ki ,k1 1 .start , 

1,11,  imin,  li,  Hi,  jk,  if 
compare_value , temp_value , sum 

Begin 

For  i  ; =  1  to  n  do 
For  i : = 1  to  m  do 

reduction_matrix[i , j ]  :=  dumy_squar e [ i , j ] ; 

compare  value  :=  1.00E-8; 

Jj  c  :  =  1 T 
Nmin  : =  n  -  1 ; 

If  nmin  =  0  then  goto  235; 

For  i  :=  1  to  nmin  do 
Begin 

For  d  :=  ddc  to  m  do 
Begin 
J d  :  =d ; 

For  k  : =  i  to  n  do 
Begin 
K.i  :  =  k  ; 

If  abs(  reduction  matrix[k,j])  >=compare  value 
then  GoTo  142;“ 

End; 

End; 

GoTo  235; 

142: If  kj  =  i  then  GoTo  145; 

For  d 1  : =  d  d  to  m  do 

Begin 

Temp  value  :=  reduction  matrix[i , d 1 ] ; 

reduCt ion_matrix[i , d 1 J : =reduction_matrix[kd , d 1 ] ; 

„  reduction  matrix[kJ ,d 1 ]  :=temp  value; 

End;  “ 

145:temp  value  :=  reduction  matrix[i , d d ] ; 

For  ik  :=  Jd  to  m  do 

reduction_matr ix[i , d k]  :=  reduction  matrix[i,jk] 

/  temp__valUe ; 

If  i  <>1  then  GoTo  180; 

162:for  1  :=  start  to  n  do 
Begin 

Temp  value  :=  reduction  matr ix I 1 , d d 3 ; 

If  HbsC  reduction  matr ix[l , d d J )  <=  c 
then  GoTo  170;“ 

For  11  :=dd  to  m  d 
reduct ion_matr i 
temp 

170: End; 

GoTo  200; 

1 80 : imin  : = i - 1 : 

For  li  :=1  to  imin  do 
Begin 

Temp  value  :=  reduction  matrix[li , 3 d 3 ; 

If  Sbs(  reduction  matr ix [ 1 i , j 3 ] )  <=compare  value 
then  GoTo  198;“  — 


compare  value 


1  dp 

’ix[l , 11 J : = re duct ion  matrixTl , 11] - 
)_value  *  reduction_Hatr ix[i , 11 J ; 


r, 

■i 

nl 


a 

j 

j 

j 
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For  111  :=  j 1  to  M  do 

reduction  matrixTli , 111 J  :  =  ^ .  .  .  r,  .  .  . 

reduction- matr ix[li , 1 li] -reduct ion  matrix  Li ,  111  J 

—  —  *temp_value; 

198  :End;  start  :=  i  +  1; 

GoTo  162; 

200: If  In  =  m  then  goto  235; 

_  Jjc  : =  30  +1 ; 

End ; 

For  Jk  :=  3  3  to  m  do 

6?emp  value  :=  reduct ion_matr ix[n , Jk] ; 

ljC  abs  (^reduction  matr ix [n , 3 k] )  <=  compare_value 
then  GoTo  226; 

For  11  :*  jk  to  m  do  _  ^  .  ,  r  / 

reduction  matr ix[n , 1 1 ]  :=reduction  matr ixLn , 3 1 J / 

—  temp_valu3'; 

GoTo  228; 

226 : End ; 

GoTo  235; 

228:For  lf:=  1  to  nmin  do 

Gfemp  value  :=  reduction  mat r ix [If . 3 3 c] ; 

If  2fos(  reduction  matrix [If . 3 3 c] )  <=  compare_value 
then  GoTo  234; 

F°re'luctionCmatr  ixflf  ,  j  1  ]  :  reduction  matr  ix[lf  ,  j  1  ] 

~  -temp  value  *  _  _ 

reducti5n_matrix[n , 3 j c] ; 

234 : End ; 

235: Rank  :=0; 

For  i  : =  1  to  n  do 
Begin 

Sum  : =  0.0: 

For  j  : = 1  to  m  do 

Be?fn  abs( reduction  matr ix[ i , j ]  )  <=  compare_value 
then  reduction  !Hatrix[i  .3  J  :=  0  -  0  ;  r  , 


if  abs( reduction  matr ix [ i , 1 ]  )  <=  compare_ 
then  reduction  matrix [1,3]  :=  0 • 0 ; r, 

dumy  square  [i  =  reduction  matrix  Li  V1J  ; 

Sum  T  =  sum  +  abs  ( reduct ion_m3trix[i , 3 J ) ; 
End;  - -  - .  _ 


value 


If  sum  >=  compar e_value  then  rank  :=  rank  +1 ; 
End; 

End; 

Procedure  matrix  mult ipl ication( VAR  matrix.matr ixl , 

—  matr ix2 : Aryl s ;  . 

VAR  L,M,N  : Integer); 


var  mult  matr ixl , result  matrix ,mult_matr ix2 
k,  3  ,  i 


Begin 

For  3 : = 1  to  m  do 
begin  ,  , 

For  i  : - 1  to  1  do 
begin  _  j  _ 

mu 1 1 _ma t  r ixl  [ i , j  j 
end; 

For  k:=1  to  n  do  _ 
mult  matrix2[j,kj 

End ; 

For  i  : = 1  to  1  do 


Aryl s ; 
Integer ; 


=  matr ix[i , J ] ; 

=  matr ixl [ j , k]  ; 
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Begin 

For  j : = 1  to  n  do 
Begin 

result  matrix[i,l]  :=  0.0; 

For  k:  =  1  to  m  do  „ 

result  matr ixfi . j J  : =  result  matri 
mult  matrixf[i,kj  *  mult  mStrix2 
End;  ~  — 

End; 

For  i ; =  1  to  1  do 
Begin 

For  1  : =1  to  n  do  _ 

matrix2[i,j]  :=  result  matrix[i,jj; 
End;  — 

End; 


] 


+ 


V. vv^.v  w  v  v  -/v'.wv  v  v  v  v>v.v  v  ww"j’>v  v  v  wv  rv  ->  -.■  v  v  ’■>  v  v-_»  v  v 
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i 

•  m 

-V 
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procedure  Inverse_find_matr ix( VAR  A:Ary1s; 

var  XD0T:ary4; 


label 
var 


var  ORDER : integer ; 
var  AINV: aryls; 
var  X : ary4 ; 

var  singular : integer ) ; 
5; label  6; label  12;label  16; label  20; label  51; 


B2 


comp . temporary  value 
n  ,  i  ,  j  ,  k ,  m 


: aryl s ; 

:  real ; 

: integer 


begin 
n  :  =  1  : 
for  l : = 1 
begin 

for  J : = 1 
begin 


to  order  do 
to  order  do 


end ; 
end; 
for  i : = 
begin 


1  to  order  do 


IftjJitiJiiii, 

end; 

for  i:  =  1  to  order  do 
begin 

comp : =0 . 0 ; 

^  •  ss  i  • 

6:if’(abs  (B2[k,i]) 


-abs(comp))  <=  0.0  then  goto  5; 


comp: =B2 [k , i] ; 
n :  =k ; 

ii*  (border)  <=  0  then  goto  6; 

ij  =  0.0  then  goto  51; 
0  then  goto  51 ; 

0  then  goto  12; 
order  do 


A  >rary  value  ;  „ 
value:  =  AlNV[i,m]; 


if 
if 
if 
for 
begin 

temporary  value : =  B2[i,m]; 

noFi,mT  :=?2tn,m]; 

B2  Ln , m]  :=temporar 
temporary  value :=  AINV 

i twvi  »nil"r=  AINV [n  , m]  ; 

AINVLn ,m] : »  temporary  value; 
end;  ~ 

temporary  value :=X[i] ; 

X  Li J : =X [n] ; 

X£n1  ^temporary  value:, 
l2:xtiJ:=X[iT  /“B2fi,il; 
temporary  value : =  B2Li , 1] ; 
for  m:=1  to  order  do 
begin  „ 

AINV [ i . m] :  =  rAINY[i ,m] 

B2[i,ml :=B2[i,m]L7  te 

end; 

for  J:=1  to  order  do 
begin 


/  temporary  value; 
temporary_valu^; 
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be 


SlNV[j  ,n]:=  AINVC.-j.nl  -  temporary  val 

•noT-i  _  1  .  _ 


ue 


B2[J ,n] : =  B2 [j ,nj  - ’ temporary_value  *  B2[i,n]; 

6  IT  CL  f 

1 6 : end; 
end; 

foto  20; 

1  :  singular :  =  1  ; 

20 : end; 


•A 


....  />?.*> 
»  k!iAA^ 


'■.’■r.  ^■.uv.vw.v'v  -.vv v'.vny1*  irvw"*'  v.vv.’vi.i,-  w>.->  vv^y^'-vvv'..  <_■ .  r,  <-*  r. 


K 
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Procedure  linear_equation( var  AA:ary2; 

var  nw,m: integer ; 
var  BB,x:ary3; 
var  K: integer; 
var  U:ary2); 

label  1*  label  2:  label  3:  label  4:label  5;label  71; 
label  8j;label  120;label  8;label  6  ; label  10; label  130; 

13.06 1  fp 

Var 


is,it,kk,n,k1 ,iitmm,i J 
al 
id 

bl , cl , ic ,w 

Begin  {linear  equation) 
n : =nw ; 
mm: =  m+ 1 : 

for  i:=i  to  n  do 

§1?i,mm]  :=  BB[i] ; 

for  i : =  1  to  m  do 
Al  L i »  J  J  :=  AA[i,J] ; 

End: 

lj;  s  j  • 

if  (n-m)  >=  0  then  goto  1 
it : =  n+1 ; 
n :  =m: 

for  i : a  it  to  m  do 
Begin 

for  1 :=1  to  mm  do 
Al  ti  ,  j]  :»  0.0; 

End; 

1 : for  i:  =  1  to  m  do 

ID[iJ:«  i; 

2 : kk : =k+1 ; 
is : =k ; 
i  "t  *  =  k  * 

B1 : =a6s( Al [k,k]  ) ; 
for  i:=k  to  n  do 
Begin 

for  J : =k  to  m  do 


: integer ; 
: ary2 ; 

: ary3 ; 

: real ; 


Begin 

l^C  r bs( Al [i , J ] ) -Bl )  <=  0  then  goto  3; 

IS • : 1 ; 

,  Bl :=abs( Al [i , J ] ) ; 

3 :End; 

End: 

if(is-k)  <=  0  then  goto  4; 

for  j : =  k  to  mm  do 

Begin 

End: 

4:ir(it-k)  <=0  then  goto  5; 
ic;  =  ..D[kT;r 
ID Lk  :  =l£)[i t]  ; 

IDLit]  :=ic; 

for  i : =  1  to  n  do 

Begin 

Cl  : =A1 fi , it] : r 
Al  [i  ,  it  J  :  =  A i  [ i  , 


k]; 
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Al[i,k]  :  =c1  ; 

End: 

5: if  A1[k,k]  <>  0  then  goto  71; 
kk:=k: 
k  :  =  k  “*  1  * 

for  i : =kk  to  m  do 
A1  Ld .d J  :=  -1  .0; 

goto  6: 

71:if  (k-n)  >0  then  goto  120; 
if  r ( k-n )  <  0  then  goto  81; 

AILn.mm]  :=A1[n,mmJ  /  A1[n,n]; 

§0X0  ip 

^1:for  d s =kk  to  mm  do 

efl?k,d]  :=  A 1 [ k , i 3  /  A1  [k , k] ; 
for  i:=  kk  to  n  do 
Begin 

Yi  f^1  » ^]  .  *  rAl  Clf  .Jl  i 

A1  [i , i J  ; =A1  [x.  i J  -w; 

if  (abs(AlTi ,jj  )  -  0 . 0001  *abs( w) )  >  = 
then  goto  8; 

Airi.dJ  : =0 . 0 ; 

8: End; 
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8 : End;  ' 

End: 

if  (k-m)  >0  then  goto  120; 
if  (k-m)  =  0  then  goto  6; 
k : =kk ; 
goto  2: 

o:for  i:=kk  to  n  do 

if  A1[i,mmJ  <>  0  then  goto  120; 

7 : kl : =k-1 ; 

for  is:=1  to  kl  do 

Begin 

i : =k-is : 
ii : =i  +1 : 

for  it:=ii  to  k  do 
Begin 


gin 

for  1 : =kk  to  mm  do, 

Al[i,dJ  : =A1 [i , d ]  -A1 [i , it]  *Al[it,d]; 


End; 

End; 

for  i : = 1  tom  do 
Begin 

for  d : =1  to  m  do 
Begin  _ 

xj1  J.  :  Id  AmmJ  ; 

if  (k-m)  =  0  the 


0  then  goto  10; 


if  (k-m)  =  0  then  goto  10; 
for  is:=kkto  m  do 

U[i  ,  is-k]  :=  A1[d ,is] ; 


1 0 : End ; 
End; 
k : =m-k : 
goto  130; 


1 20 : Writeln ; 

,  There  are  no  equations  ’  )  ;Delay(  2000  )  ; 

130:End;  (linear  equation) 


*  V  V  V  V  V  V  V  V»  > 
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Procedure  Polynomial_of  roots(var  n: integer: 


l  o  v  v  cu  ii  .  iiHCgcr; 

var  rr,ri:ary3s; 
var  of : ary4 ) ; 
e  coefficients  of  a 


,  var  ci  :  aryq- ) ; 

{This  program  calculates  the  coefficients  of 
polynomial  from  its  roots) 

label  1;label  3:label  111;label  222;label  2; 
label  5 ; label  21; label  50; 


▼  ox 

i ck , nn . mp , i , i i . 1 , m , mm , mmp 

sumreal , pr real 1 , sumimag , pr real , pr imag 

J 

Begin 

nn;=n+1 ; 

CF [nn] :  =  1  .  0 ; 

for  m:=1  to  n  do 

Begin 

sumreal : =0 . 0 ; 
sumimag : =0 . 0 ; 

iiTjl.i; 

2:if  (1-m)  >0  then  goto  50; 
if  (1-m)  =  0  then  goto  5; 
mm: =m-1 ; 

for  i : = 1  to  mm  do 
Begin 

ii:»  i+1 s.  _ 

J[ii] :-j[i]+1 ; 

End; 

5 :prreal : =1 . 0 ; 
prreal 1 : = 1 . 0 ; 
primag:=  0.0; 
for  i : *  1  to  m  do 
Begin 

prreal ; =pr real 1 ; 
ick: =j[i J ; 

prrealT:=  prreal  *RR  Lick]  -  primal 
primag:=  prreal *RI [ick] 


: integer 
: real ; 

: ary6 ; 


prre; 


=  prreal *RI [ ick] +pr imag*  _ 

End ; 

sumreal  :=  sumreal+prreal 1 ; 
sumimag : =  sumimag+pr imag ; 
for  i : = 1  to  m  do 
Be^in 

if  (JLlj-n+m-1)  >0  then  goto  50; 
if  (J[lj-n+m-l)  <0  then  goto  1; 

End; 

mp : =n-m+ 1 ; 

mmp : =mp  mod  2; 

if  mmp  <>  0  then  goto  111; 

CFrmp]:=  sumreal ;goto  222; 

1 1 T :  CF[mp] : =-sumreal ; 

222 :End; 

foto  21 ; 

0 : Writeln * 

Wri teln( ’ T&ere  is  an  error  in  polynomial 

,  calculation  from  roots  procedure’); 
Delay ( 2000 ); 

21 :mmp : =  n  mod  2 ; 
if  mmp  <>  0  then  goto  3; 
for  i:=  n  downto  1  do 
CF[i] : =-CF[i J ; 


-  primag*RI [ick] ; 
pr imag*RR [ick] ; 


:  0  then  goto  1 ; 


-sumreal ; 


:  End ; 
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(Plot  Nyquist  is  a  routine  to  draw  the  Nyquist  plot 
from  the  data  generated  in  the  Nyquist  procedure.  ) 

Procedure  Plot_Nyquist ( StartDecade ,  EndDecade , 

NumberDecades : Integer ; 

FreqArr ay , PlotArray 1 , 

Plotarray2, 

MagPhaseArr ay : PlotArray : 

BigPic , OpenLoop : Boolean ) ; 


var 

Xint.Yint,  i,1,n,code  : 

Ymin.Ymax,  Xmm.Xmax  : 

XLabel , YLabel  : 

Titlel ,Title2  : 

DumpGraph , qui t  : 

w, XminL , YminL  : 

GraphWidthX , GraphWidthY : 
Xexponent , Yexponent  : 

XexpLabel , YexpLabel  : 

GraphArray  : 

List  : 


:llj ; 


integer ; 
real ; 
String 
String 
Boolean ; 
Real : 

Real ; 
integer : _ 
str ing[3] ; 
PlotArray ; 
text ; 


function  Expon( Y , X : real ): real j 

(computes  Y  raised  to  X  power) 


Begin 
Expon 
end; 

Procedure 


=  exp(  X  *  ( ln( Y  ) ) ) ; 


Pr intGraphData; 

(dump  data  used  to  make  graph  to  printer) 

Begin 

Leave Graphic ; Clrscr ; 
repeat 

Textcolor (white );  gotoxy (20 , 1 0  ) : 

'  ’  ***  PROGRAM  OUTPUT  0PTI6nS  *** 

v  ..0,  1  3  )  ;writeln(  ’  <  P>  Printer  output 
lor ( yellow ) ;  gotoxy ( 20 , 1 4  )  ; 

writeln( ’  Check  Your  Printer! 

Textcolor ( white ) ;  gotoxy ( 20 , 1 5  ) ; 

writeln(’<F>  List  to  File  name 
gotoxy ( 20,16); 

writelnf’  on  the  current  drive 

gotox^C ?0 ,17) 


writelnl 
gotoxy( : 
Textcoj 


’  ) 

); 
’  ) 
’  ) 


write. 


<q;  $uit 


textcolor (yellow) ;write( ’ "NYQUIST . RES" 
got oxy ( 28 , i 7  )  ; 


) 


read 

If 


beg 


ch  =  ’ F 5 
ch  =  ’ p ’ 
.n 


) 


or  ( ch  = 
then 


f’)  or  (ch  =  ’P’)  or 


if  ( ch  =  ’F’ )  or  (ch  =  ’f ’ )  then 

begin 

gotoxy ( 24,15);textcolor(red); 

write!  ’ PRINTING . 

assign(list, ’ Nyqui st . RES ’ ); 
rewr ite( list ) ; 
end 
else 
begin 

gotoxy ( 24,13);textcolor(red); 

’■  7lNTIN“ 


write( ’ PR! 


assign( 1 is 
rewr i te ( 1 i 


:ng, 

t  ,  ’  LST  : 
st  )  ; 


); 


) 


); 


1  45 


jr.'^VT. WV*V'P.  ”.  ^  "V  wv^V".^.  v,  w.  ^.,T.  'r. 


FILE:  PLOTNYQS.INC  Program  Listing 


end: 
Tit lei 


=  (  ’ 
Phase 


w  (rad) 
(rad) 


Magnitude 

Xplot 


Tit le2 : = 
wr iteln( 
write! 
writel 
wr itel 
for  i  : 
begin 
w  :  - 
writ 


list,’  NYQUIST  PLOT  RESULT  s); 

n( list ) : wr iteln( list )  : 
n(list.Titlel);  Writeln(list,Title2); 
n(list);  writeln( list ) ; 

=  1  to  6l  do 


Page  2 
YPlot  ’  )  ; 

>i 


>E?!tS5XE4:J}« 


if  i 
begi 
wr 
wr 
wr 
wr 
wr 
end; 
end; 
end; 

until  ch  in 
EnterGraphic 
swapscreen ; 

close( list 
end; 


MagPhaseAr 
MagPhaseAr 
PlotArray 1 „ _ 
PlotArray 1  [i 
then 


=  47 
iteln( 1 ist ) 


ray  [  j 

pay  [: 

,2 

t 1 ,  T , 

:  1  5 

[i  * 2. 

:  1  0 

1  1 
1  1 
3 
3 


:  3 
:  3 


)i 


itefl . 
itelnl 
i telnl 
itelni 


J.XOU,X-LU-»-Cl  )  f 

list ,Title2  ) ; 
list);  writeln( list ) ; 


st , chr (12, 
list , Title 


C ’ Q ’ , ’q’] ; 
» 

); 


Begin  (Plot  Nyquist)  (prompt  for  window  parameters) 
if  not ( BigPic )  then  H  K 

begin 

’ 1 51 1N00503-01 01 01  ‘ 

’ 1 51 2N00504-01 01 01 
’ 1 51 3N00505-01 01 01 
’ 1 51 4N00506-01 01 01 


P  3] 
P  .41 
P  .5] 

P  6 


Clrscr;  TextColor (LightBlue ) ; 
writeln( ’  ***  NYQUIST  PLOTTING  PARAMETERS 

textcolor (yellow) ; 

5  In 


*  *  *  >  )  j 


HighVideo; 

writeln;writeln:Textcolor( white): 
msg( ’ Input  Plotting  Coordinates  for  the 
Nyquist  Plot’;i,6); 

TextColor (yellow) ; 

writeln: writeln; writeln; writeln;  writeln; 
writelni ’X-Minimum: 
writelnt  ’X-Maximum: 
writelnl ’Y-Minimum: 
writeln( ’Y -Maxi mum: 


Input  Handl er (’ N0306 ’, Escape ) 
writeln: writeln; 
writeln(’Any  changes  to  these 
(  Y  /  N  )  :  ’  )  : 

Input ( ’A’ , ’ ’45, 16, 2, true, FI ,F10) 
If  (answers’?1)  or  (FI)  then 

Input  Handl er (’ C0306 Escape ) 
Val ( f i lvaFT3T , Xmin , code ) ; 

Val  ( f i lvar [4 J , Xmax .code  ; 


parameters? 
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Val  ( 
Val( 
end 
else 
begin 
Xmax 


Xmin 

Ymax 

Ymin 

end; 


f i lvar [5], Ymin, code); 
filvar [6] , Ymax, code ) ; 


:  =  100; 

{set  default  values 
:  =  -100; 

:  =  100; 

:  =  -100; 


for 


"big  picture"  plot) 


INITGRAPHIC: 

niceaxes ( xmin , xmax , ymin , ymax , 

n  :  s  1  * 

for . I : = 1  to  80  do 


); 


if.(ab5(pl9tarra.y^[i^j 


1 )  >  Xmax )  or 
)  >  Ymax)  then 


n : =  n+1 


(  abs  (plotarray  . 
if  n<>1  then  n:=  n-1 ; 

(use  1  extra  point  beyond  graph  border) 


DrawPolygon( PlotAr ray 1 ,n 
n  .  -  1  * 

fori:*1  to  80  do  _ 
if  (abs(plotarray2[i , 1 ] ) 

(abs(plot 


,  -80 ,0,1  , 0 ) ; 
{draw  graph 


>  Xma 
array 1 


on  screen) 


>  Ymax)  then 


n : =  n+1 ; 

if  n<>1  then  n:=  n-1; 

Setlinestyle  (1  ) ; 

DrawPolygon( Ploxarray2 ,n , -80 ,0,1  , 9  ) ; 

Repeat  until  Keypressed; 

{Put  option  menu  on  screen) 

quit : =  false; 
repeat 

if  OpenLoop  then 

Graph  MenuC’Open  Loop  NyquistPlot ’ , 

~  DumpGraph , qui t ) 

©  1  S  G 

Graph_Menu( ’ Closed  Loop  Nyauist  Plot’, 
DumpGraph , quit ) ; 

if  DumpGraph  then  Pr intGraphData ; 
until  quit: 

LeaveGraphic ; 
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{Graph  Menu  provides  a  window  on  screen  and  offers  the 
user  options  to  make  a  title,  print  the  graph,  print 
the  numbers  from  the  graph,  or  quit  and  return  to  the 
menu .  > 

Procedure  Graph  Menu( Tit leWindowName : STR25 ; 

var  DumpGraphData , qui t  :  boolean); 


var 

Linel 


Line2,  Line3 


string[40] ; 


Procedure  TitlePrompt; 
begin 

Text Col or (White ) ; 
Center  <  ’  *  *  *  nranh  th 


lor ( White ) ; 
(  ’  *  *  *  Graph 


.  :  =  *101 
f  :  =  ’101 

i  :  =  ’101 


Graph  Title  ***’,1,2,80); 

0A04001  -010100’  ; 

2A04002-0 1 0100’  ; 

4A04003-0 1 0100’ ; 


textcolor (yellow) ; 
msg( ’Line  1 : ’ , 1 , 1 0 
msg( ’Line  2 : ’ , 1 , 1 2 
msg( ’Line  3 : ’ , 1 , 1 4 


textcolor ( green ) : 

msg(’Type  your  title  for  your  graph . ’ , 6 , 20 ) ; 
Input_handler ( ’ N01 03 ’ , escape ) ; 


Linel :=  copy(filvar 
Line2:=  copy(filvar 
Line3:=  copy(filvar 

end; 

Procedure  ShowTitle; 
(makes  title  bloc 


-  £  -  t  ■  9 

[3]  ,  1  , 


malces  title  block  and  writes  title  to  block) 


begin 

copyscreen 

SetLineSty 


SetLineStylef  0 ) : 
Def ineWindowf 3 , 1 1 , 
Def ineWor ld( 3,0,0, 
SelectWor ld( 3 ) ;  Se 
Def ineHeader ( 3 , Ti t 

SetBackground( 0 ) ; 
SetHeaderOn ; DrawBo 


neSt.ylef  0 )  : 

eWindowf 3 , 11 ,20,40,60); 
eWor ld( 3,6,0,40, 16); 
tWorld(3);  Se lectWindow( 3 ) ;  , 

eHeader ( 3 , Tit leWindowName ) ;  { 


puts  header 


box ) 


DrawTextW 

DrawTextW 

DrawTextW 

SetBreakO 


1  ,4,1  , Line  1  } ; 

1.8.1  . Line2  )  : 

1.12.1  ,Line3  )  : 

'f ;  SetMessageOf f ; 


repeat 

read( kbd, ch ) ; 
case  ord(ch)  of 
(allow  user  to 


72  :  MoveVeri 
75  :  MoveHori 
77  :  MoveHor' 
80  :  MoveVer' 
end ; 

until  ord(ch)= 
(free 


move  tit 
-4 , true ) ; 
-1  . true  )  ; 
1  , true  )  ; 

4 , true ) ; 


!  box  anywhere  on  screen) 
up  arrow) 
left  arrow) 
right  arrow) 
down  arrow) 


ch)*  13; 
freeze  box 


continue  with  <return>  key) 
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DumpGraphDat; 
selectscreenl 
copyscr een ; 

{  save 


=  False 


under  lym 

Def ineWindowf 4,1  1  ,  20  ,  ? 

Def ineWor ld( 4,0,0,20,20); 

^  -i-  T.7 _ 1  m  /  A  \  -  L  1  _  1  xl.li  .1 


ineStyle( 0 ) ; 

screen 
5,90); 


and  display  menu  box) 


SelectWor ld( 4 ) . 
Def ineHeader ( 4 , 
SetHeaderOn; 
DrawTextW( 1 , 4 


SelectWindow( 4 ) ; 

'Graph  Options  Menu’) 
SetBackgr ound( 0} ;DrawBorder 


DrawTextW 
Dr awTextW 
DrawTextW 
DrawTextW 
repeat 
Option ; 
case  oh 
’  P’ 


1  , ’ <  P>  Print 
{display  menu 


<  T  > 

’  <N> 

’  <Q> 


raph  to  the 
options  > 


printer ’  ) 


Make  Title  to  the  Graph’ ) 
Print  Table  of  Numbers’) 
used  to  Generate  Graph’ 
Continue  to  the  Program 


<  )  • 

’  j; 


(interpret  user  input) 


of 

begin 
swapscr een : 

(redisplays 
hardcopyC  false 
copyscreen ; 
ch  : =  ’ P ’ ; 

end  j 
begin 

leavegr aphic ; 
Ti t lePrompt ; 
entergraphic ; 
swapscr een 


screen  without 
1  )  ;  (print  to 


menu  box) 
printer ) 


leave  graphics  screen) 
prompt  for  title) 
return  to  graphics  mode) 
n ay ooi  <  vbring  back  gr ap h ) 

ShowTi tie ;{ display  title  box  on  screen) 
copyscr een ; (save  graph  with  title  box) 
ch  : =  ’ T ’ ; 


N 


end ; 
begin 
DumpGr ; 


ch 

end; 


LphData  ;=  True; 
sets  boolean  to 
to  be  printed) 
N’  ; 


cause  numbers  ) 


until’ ch  in  [ ’ P ’ , ’ T ’ N ’ , ’ Q ’ ] ; 
if  ch  =  ’Q’  then  Quit  :=  true 

else  Quit  :=  false; 

id; 


TiW&\ 
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procedure  input  Factored( Zeros  or  poles:str5; 

~  NFactoFs : integer ; var  real_part, 

imaginary_par t : ary3s ) ; 

{Begin  processing  Factored  form  Input-Internal  routine) 


var 
i  .  j 
test 

begin 


integer ; 
real; 


’ 0905N01 
’ 2505N01 
’ 0907N01 
’ 2507N01 
’ 0909N01 
’ 2509N01 
’ 091 1 N01 
’251 1 N01 
’ 091 3N0 1 
’ 251 3N0 1 
’ 091 5N01 
’ 251 5N01 
’ 091 7N01 
’ 251 7N01 
’ 091 9N01 
’ 251 9N0 1 
’ 0921 N01 
’ 2521 N01 
’ 0923N01 
’ 2523N01 


-0001 01 
-0001 01 
-0001  01 
-0001 01 
-0001 01 
-0001 01 
-0001 01 
-0001 01 
-0001 01 
-0001 01 
-0001 01 
-0001 01 
-0001 01 
-0001 01 
-0001 01 
-0001 01 
-000101 
-000101 
-000101 
-000101 


ClrScr;  TextCoIor ( White ) ;  {write  screen  titles) 

gotoXY{ 1 ,24) ; 

Invvideo( ’Press  <ESC>  to  change  an  entry’): 
Center( ’ ***  Desired  characteristic  Polynomial 
Input *** ’,1,1 ,80 ) ; 

HighVideo;  , 

writeln; Text Color (green) : 

if  Zeros  or  Poles  =  'ZEROS’  then 

writ51n( ’ NUMERATOR  Transfer  Function 
Input  --  FACTORED  Form’ ) 

else 

writeln( 'Characteristic  equation 

Input  --  FACTORED  Form’); 

HighVideo ; writeln ;wr iteln ; 

for  1 : = 1  to  NFactors  do  {type  prompt  strings) 
begin 

wr  iteln(  ’  s  =  +j ’ ) ; 

writeln ; 
end ; 

&tr( ( NF  ac tors* 2  +  1 0 ) ;  2 ,strg) ; 

specification  :=  concat (  ’ N1 1  ’  , strg  ) ; 

Input  handler( specif ication,  escape); 

{call  the  input  handler) 

for  j:=  1  to  NFactors  do 

(compute  the  zero  values  from) 
begin  (input  handler  string  Filvar) 

val C f i lvar [2 *i+9  T , test , code j ; 
if  code  =  0  then  Real  Par t [j J := test ; 

{val  conversion  successful  if  code) 
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val ( f ilvar [2*j  +1 0] .test, code); 

(=0,  error  otherwise) 
if  code  =  0  then  Imaginary_Part [ j J : =test ; 

end; 

end;  {procedure  Input_f actor ed> 

{Begin  processing  Coefficient  form  Input- Internal 
procedure  ) 

Procedure  Input  Coeff( Zeros  or  Poles :Str5; 

NCoeff : integer : 
var  Coeff:  ary4); 


var 

N6oeff_old 
test:  real; 


integer ; 
{holds 


{ counters ) 

{holds  old  poly  order  if 
changing  order) 

"val"  results  until  validated) 


begin 

p  [21  n 


p 

[22] 

p 

23 

p 

24 

p 

.25. 

p 

26 

p 

27 

p 

28 

p 

29 

p 

[30  J 

’  0406N01  021 -000101  ’  ; 

{ Input^Handler _ descr iptor s  for  coeff) 


1806N01 022-0001 01 
3206N01 023-0001 01 
4606N01 024-0001 01 
0408N01 025-0001 01 
1808N01 026-0001 01 
3208N01 027-0001 01 
4608N01 028-0001 01 
041 0N01 029-0001 01 
181 0N01 030-0001 01 


form  input) 


NCoeff_old:=  NCoeff; 

ClrScr:  TextColor ( White ) ;  {print  screen  titles) 
gotoxy( 1,24); 

invvid^o( ’ ^ress  <ESC>  to  change  an  entry’); 

write?n( 5  ’  ***  Desired  characteristic 

Polynomial  input  ***’); 

TextColor (Green ) ; 

if  Zeros  or  Poles  =  ’POLES’  then 


”5 


writeln( ’ NUMERATOR  Transfer  Functioi 
Input  --  COEFFICIENT  Form’ 

else 
begin 

write( ’COEFFICIENT  Form  - 

TextColor( 1 ightmagenta ) ; 
if  not  luen  then 

wr iteln( ’ Highest  degree  coefficient 
MUST  be  1 


’  ), 


); 


end ; 

HighV i deo ; 


>  NCoeff  old  then 


if  NCoeff 
begin 

for  1:=1  to 

for  i : =NCoef  f 
Filvar [i+1 ] 


NCoeff  old  -  NCoeff 
Uld  +  1  downt 
=  Fi lvar [ ' 


do 
to  1 

i  J  ; 


do 


end ; 

if  NCoeff  <  NCoeff  old  then 


151 
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=  1  to  NCoeff  old  +  1  do 


Filvar [i]  :=  Filvar[i+l] 
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Vp  T*  c*  •  —  A  • 

for  i : =NCoef f +1  downto  1  do 
begin 

1 : =NCoef f +1  -  i; 

PosCounter  :=  (1  mod  4)  +  1; 
HorizPos  :=  PosCounter  *  14: 

If  PosCounter  =  1  then  VertPos 


=  VertPos  +  2; 


if  i<>  1  then{prompts  for  coeff  input) 
begin  K 


end; 


msgf’s  +’, HorizPos . Vert Pos ) ; 
strfi-1 :2, Exponent); 
msg( Exponent , HorizPos+1  ,VertPos-1  ); 
end; 


end; 


str ( ( 20+NCoef f +1 ) : 2 , strg ) ;  {sets  up  and  calls 

input  handler) 

specification  :=  concat( ’ N21 * , strg) ; 
Inputjtiandler  (  specification  ,  escape  ) ; 


for  i:=  NCoeff+1  downto  1 

b?li?Fllvar 
if  code  = 
end; 


[NCoeff +22- 
0  then  Coef 


do 

.11 ,  test ,  code 
f  Lj J :»test ; 


1  52 
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procedure  characteristic  equation(var  A3:ary1s; 

—  var  N: integer; 

var  C2 : ary4 ) ; 

(This  procedures  computes  the  characteristic  equation 
polynomials  coefficients  by  using  the  principle-minor 
method) 

label  10;label  20;label  30;label  40;label  50; 
label  60;label  15;  label  70;label  80;label  90; 
label  100;label  1;label  2;label  5; 

var 

B3,A1  : aryls ; 

integer  vector  _  _  :ary6; 

D10  ~  :  array  [1..280]  of  real; 

mm, ii , 1 ,m. i ,kk,nr ,nc ,k1 ,  i  i  i  , 

counter , ml m, even ,nn,k, j 1 ,n1 ,m1  : integer ; 

temp  value , det , det  correction, 

deteTminant_old , determinant , value_c2 , value  : real ; 

begin 

nn : =n+1 : 

for  i:=1  to  nn  do 

beg|?i]:=0.0; 

end;  _ 

C2 [nn] : = 1 . 0 ; 

for  m : = 1  to  n  do 

begin 

k: =0;  1 : =1 ; 

integer  vector [ 1 J := 1 ; 

goto  2;  _  _  r  _ 

1: integer  vector [ 1 J := integer  vectorLlJ+1; 

2: if  (l-m)  >  0  then  goto  90; 
if  (l-m)  =  0  then  goto  5; 


mm : =m- 1 ; 

for  i : =  1  to  mm  do 
begin 

i  i  :  =  i  + 1  • 

integer ^vector [ii] : =integer_vector [i] +1 ; 
end; 

5 : f or  i : = 1  to  m  do 
begin 

for  kk:=1  to  m  do 
begin  _  _ 

nr : = integer_vector  LiJ i 
nc;=integer  vector ikkj ; 

B3  t i » kk j : =A3 [nr , nc J ; 
end; 
end; 
k  :  =k+ 1  ; 

counter  :=  0; 

for  i 1 i  :  =  1  to  M  do 

begin 

for  J 1 : = 1  to  M  do 

bSfl?i1i,j1] :=  B3 [ i 1 i , j 1 ] ; 
end ; 
end ; 

for  i 1 i : =  1  to  M  do 
Begin 

k  1  :  =  i  1  i  * 

30:if  Af[k1,i1i]  <>  0.0  then  goto  10; 
kl  :  *k1 +1  ’ 

if  (kl-M)  <=  0  then  goto  30; 
goto  40; 
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10:if  (i1i-k1)  >  0  then  goto  40; 
if  (ill-kl )  =  0  then  goto  70; 
for  m1m:=1  to  M  do 
Begin 

temp  value: =A1 [i 1 i ,m1 ml ; 

A1 [  i  1 i  ,  ml  m] : =AT [kl ,m1m] ; 

A1 [kl ,m1m] : =temp  value; 

End;  ~ 

counter :=  counter+1 ; 

70 : i i : = i 1 i+1 ; 
if  ii  >  M  then  goto  20; 
for  m1m:=ii  to  M  do 
Begin 

if  A1[m1nui1i]  =  0.0  then  goto  80; 
value : =A1 [ml m , i 1 i J  A1[i1i,i1iJ; 
for  nl :=  ill  to  M  do 
begin 

A1[m1m,n1]:=  Al[m1m,nl]  -  Al[i1i,n1]  *  value; 

end ; 

80 : End; 

20 :End; 
det : = 1 . 0 ; 

for  i 1 i  :  =  1  to  M  do 
begin 

aet:=det  *  A1[i1i,i1i]; 
end; 

det  correction:®  exp(  counter  *  ln(1.0)); 
determinant  old:=det  correction  *  det; 
even : =  counter  mod  2T 
if  even  <>  0  then  goto  60: 
determinant  :=  determinant  old; 
goto  50; 

60 : determinant : =-determinant  old; 
goto  50; 

40 : determinant : =0 . 0  ; 


ln(  1  .0 
*  det ; 


0)); 


50 : D1 0 [kl : = determinant ; 
for  i:=  i  to  m  do 
begin 

1 : =m-i+1 ; 

if  ( integer_vector [l]-(n-m+l )  ) 

if  (integer  vector [l] -( n-m+1 ) ) 
end ; 


0  then  goto  90; 
0  then  goto  1 ; 


ml : =  n-m+ 1 ; 

value_c2 : =exp(  m  *  ln(1.0)); 
even:®  m  mod  2; 
for  i:=1  to  k  do 
begin 

if  even  =  0  then 
begin 

value  c2:=value  c2; 
goto  15; 

end ; 

if  even  <  >  0  then 
begin 

value  c2:=-1.0  *  value  c2; 

end: 

1 5 : C2 [ml ] : =C2 [ml ]  +  D10[il  *  value  c2 ; 
value_c2 : =exp(  m  *  ln(1.0>); 
end ; 

endjgoto 

90 :writeln( ’ Error  in  characteristic  equation’); 
1 00 : end; 
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{  This  procedure  uses  modified  BARSTOW  method  to 
calculate  the  roots  of  the  polynomial  > 

PROCEDURE  root_f inder ( var  n: integer; 

var  A:ary4; 
var  u,v:ary3s; 
var  ir: integer); 

{  label  decleration  for  the  GOTO  statement) 

label  3;label  4;label  7;label  9;label  10;label  13; 
label  15;label  19;label  20;  label  23;label  30; 
label  32;label  33;label  34;label  36;label  49; 
label  50;label  52;label  53;  label  70:label  72;label  73; 
label  7 5 ; 1 ab e 1  76;label  81;label  82;label  100; 


irev , i , nc , m , nl , np , j , i 1 : integer ; 
p , q , r , f , e , cbar , d, qp , pp : real ; 

H , B , C :  array  [1..21]  of  real; 

Begin 

irev:=ir;  {take  given  values) 
nc : =n+1 : 

for  i:  =  1  to  nc_do 
Hti]  A[i] ; 

p:=0.0;  (initialization) 
q  :  =0 . 0 ; 
r : =0 . 0 :  „ 

3:if  H [ 1 ]  <>  0  then  goto  4; 
nc : =nc-1 ; 

U [nc. : =0 . 0 ; 

V [nc] : =0 . 0 ; 
for  : =  1  to  nc  do 
H[i]  :=  HLi  +  1 ] ; 

goto  3; 

4:if  (nc-1 )  =  0  then  goto  100; 
if  (nc-2)  <>  0  then  goto  7; 
J/H[2] ; 


goto 

7 : if  ( nc-3 )  < >  0  then  goto  9; 
p  :  =H  [2  J  /H  [3  ; 
q: =H[1 1/HL3J ; 

fot o  7 0 ; 

:lf  ( abs( H [nc- 1 ] /H [nc] ) -abs ( H [2] /H [ 1 ]  )  )  >  = 
then  goto  1 9 ; 
irev: =  -  i rev ; 
m:=nc  div  2; 
for  i : = 1  to  m  do 
begin 

nl  :  =nc  +  l -i ; 

itafeiJtus 


<  >  0  then  goto  9 ; 


H  tnl ] : =H 
H[i J : =F ; 


CI1U  . 

if  0  <.  >  0.0  then  goto  13; 

p  :  =0 . 0 ; 

goto  1 5 : 

1 3:P:=9/q; 
q  :  =  1  • 0/q ; 

15:if  r  =  0.0  then  goto  19; 
r  :  =  1  .  0  /  r  ; 


^  «.  r  m\  »  t  -  V  -V  Aa  *  to**  ft  A.*V  «  W.  m  ^ 


>  >-■  -  v/v v.v.v.v.v. -  .-r. 
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1 9 : ej =5 . 0e-  0 ; 

B  .nc  J  :  =H [nc.  ; 

C .nc] : =H [nc  ; 

B .nc+1 ] : =0 . 0 ; 

C[nc+1 ] : =0 . 0 ; 
np : =nc- 1 ; 

20:for  j  :  =  1  to  1000  do 
begin 

for  i  1  :  =  1  to  np  do 
begin 


BfI??=Hh]  +  R  *  B[i  +  1  ]  ; 

end-  1  :=B*-i-‘  +  R  *  C‘-i  +  1  ■*  ; 
if  (,9-bs(  B[  1  1/H[  1 1  )-e  )  <=  0.0  then  goto  50; 
if  C[2J  <>  0.0  tnen  goto  23; 
r  :  =  r  + 1  .  0  : 


*  BCi+1]; 

*  C[i+1]; 


r : =r+1 . 0 ; 

foto  30;  _  _  .  _  _ 

3:r  :  «r  -  B[1 ]/C[2] ; 
30:for  il :=  1  to  np  do 
begin 


end; _  „ 
if  $[2] 
if  (abs 
if  (abs 
32 : if  ( 
33  :  if  (a 
34 : char : 
d: =C [3 J 


ti]  -  p 

*  B 

!i  +  i  ] 

-  q 

*  B 

!  i+2] 

[ij  -  P 

*  C 

.i  +  i  J 

-  q 

*  c 

.  i+2  J 

{Mi 


.0  th 
/H  [  1  . 
/HI  1 
2.  /H 
.aJ/H 


then  goto  32; 

1.  )-e)  >  0.0  then  goto  34; 

<  =  0-0  then  goto  33; 
/H.2J)-e)  >  0.0  then  goto  34; 
/H  llj-e)  <=  0.0  then  goto  70; 

—  <  I  0  I  • 


-/*T  «  ^  U  d.1  •  =  0  14  1  —  0  14  1, 

d:=C[3J  *  C[3J  -  cbar  *  C[4]; 
if  d  <>  0.0  then  goto  36; 

p : =p  -  2.0; 

q:=  q  *  (q  +  1.0); 

?oto  49; 

6:p:=  p  +  CBf2l  *  C[3]  -PBfl]  *rCr4l)/d; 
q:=  q  +  (-B[2]  *  cbar  +  B[l]  *  C[3])/d; 

49  •  end , 
e : =e  *  10; 
goto  20; 

50 : nc : =  nc-1 ; 

V  r nc ] : =  0.0; 

if  irev  >=  0  then  goto  52; 

U[nc] : ^ . 0/r ; 

fi?8cSlj..r, 

53 tfor  i:=l  to  nc  do 
H[i j ; =  B  L i  + 1 ] ; 

foto  4 ; 

0 : nc ; =nc-2 ; 

if  irev  >=  0  then  goto  72; 
qp  :  =  1  .  0  /  q  ; 

PP:=P/iq  #  2.0); 
goto  73; 

<  2 : qp : =  q; 
pp : =p/2 . 0 ; 

I?:?:;2P0:0P?hin<5|ito  75; 

U.nc*1J:=  -pp; 

U .nc J : = -pp ; 

V .nc+1 ] :=sqrt(-f); 

V [nc J : =-V [nc  +  1 ]  ; 
goto  76; 

75:if  pp  <>  0.0  then  goto  81; 


s 

V 


H 
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U[nc+Il:=  -sqrt(f); 
to  to  ,.82; 


82;vte:!3ir^§{abs(pp))  *  (  abs(pp) 

fe3:::0?§{u[no+']; 

76  :  for*  i  :  =  1  to  nc  do 
H [i ]  :  =  B[i+2J; 


Page  3 
sqr t ( f ) ) ; 


goto  4; 
1 00 : end; 
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